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ABSTRACT 


The problem of finding the shortest path between two 
points in the plane containing obstacles is considered. The 
set of such paths is uncountably infinite, making ап 
exhaustive search impossible. This difficulty is overcome by 
reducing the size of the search space. The search is first 
restricted to a countably infinite set by focusing attention 
on the set of homotopy classes. By applying simple optimality 
principles, we obtain a finite list of such classes whose 
union contains the shortest path. This process of 
simplification is discussed in the thesis of CAPT Kevin D. 
Jenkins, U.S. Marine Corps. In this thesis we first discuss 
a computational investigation of two methods by which homotopy 
classes can be named. Next, a computational heuristic is 
presented that finds the lower bound for a path in a class. 
Finally, the true shortest path is found by searching these 
classes in order of increasing lower bound. One application 


of this study is in the area of robotic path planning. 


vir 


/ А ау 


7 Z 7 44 2 


%4 


THESIS DISCLAIMER 


The reader is cautioned that computer programs developed 
in this research may not have been exercised for all cases of 
interest. While every effort has been made, within the time 
available, to ensure that the programs are free of 
computational and logic errors, they cannot be considered 
validated. Any application of these programs without 


additional verification is at the risk of the user. 


іу 


I. 


TABLE OF CONTENTS 


eg OD)! Ξ ' ν ЛК... ν.“-... , , , . « . . 1 
Aec OS. EOS  -------ᾱ:.:«.:. : « « « 1 
ИТЕР ρα ο τε SOLUTION ,.......... 1 
τν PP p OCH? 0722 2777,724.2,...... 2 
ї OS TODO] OGyYy NL. usc oos o. < 2 
2. Establishing the Naming Convention . . .. 3 
3. Generation of Names for Candidate Equivalence 
Classes DX. e c—— SV os. + 4 

4. Heuristic Ordering of Candidate Homotopy 
Classes ee es ee ИШ з з 2. 4 


5. Class by Class Solution of the Shortest Path 


Problem ТТ ИЕ ........ 5 

D. SUMMARY О О 6020... 5 
τ: .... . WE m. ovum. . 6 
NAMING БӨШІМАҺЕНСЕ СРАББЕБ МН 22.2. 7 
А. ΗΡΙ ΠΙΟ, c 2.2... 7 
B. CONSTRUCTION OF REFERENCE FRAME SF... . . 8 
С. RAWWSHARACHEBR. STRINGS . . ο, ."« . . . . . . 9 
JO | O στ. JD c ο νο s< ο + ш 
A COMPUTATIONAL INVESTIGATION м... ж....... 13 
A. INTRODUCTHON 2 ТИЕК М. .... 13 
ΓΕ Н oe oe ee . . 13 
1. Fundamental Group Sees . :.. 13 

О ОЕ ОПЕЛ Gorath. mm n . . . . . 17 

a. πο Array p :.: .: 9o o 17 


IV. 


VI. 


C: 


D: Switch Function 
c. Index Function 
q: The Algorithm 


е. Fundamental Group Cancellation 
Function 


THE COMPUTATIONAL INVESTIGATION 
1. The Approach 


2. The Test 


DETERMINING A BOUND FOR A HOMOTOPY CLASS 


А. 


Б” 


C. 


INTRODUCTION 


FINDING THE BOUND 


1. Establishing a Cone of Directions 
2. Class Names Defining Cones 
oe Intersecting Multiple Cones 


4. An Empty Intersection 


THE ALGORITHM 


FINDING THE SHORTEST PATH 


A. 


B. 


D. 


INTRODUCTION 

FINDING LINE SEGMENTS 

DETERMINING THE CORRECT TANGENT LINES 
1. Point to Obstacle | 

2. Obstacle to Obstacle 


TWO POTENTIAL PROBLEMS TO CHECK 


CONCLUSIONS AND RECOMMENDATIONS 


ЕЕ 


В. 


CONCLUSIONS 


RECOMMENDATIONS FOR FURTHER STUDY 


мі 


17 


17 


18 


19 
20 
20 
21 
24 
24 
27 
27 
20 
28 
31 
33 
35 
35 
36 
41 
41 
42 
49 
56 
56 


58 


ESEENDIX А. FORTRAN PROGRAM .............. 60 


KS IO А ӘНОКТ EXAMPLE ............. 102 
тт олчоо c —————————SPOlI- 
νι... DISTRIBUTION LIST, . . . . -—— e. o... 109 


vii 


ACKNOWLEDGMENTS 


I fully acknowledge the assistance I received from Dr. 
John Thornton, Naval Post School Mathematics Department, and 
CAPT Kevin D. Jenkins, U. S. Marine Corps. The tremendous 
support of these two professionals was critical during my 
effort to complete this thesis. 

Dr. Thornton's staunch guidance inspired the motivation to 
start this work and the determination to finish it. In 
addition to other technical assistance, Dr. Thornton 
established topological proofs which support the theories 
behind the algorithms presented in Chapters II and III. 

Much of the research for this project was conducted in 
conjunction with the thesis research of CAPT Jenkins. We 
Spent many months together writing and debugging the FORTRAN 
program which is presented in Appendix A. Following the joint 
research and development of the shortest path problem, Chapter 
I (with the exception of minor changes) was written by CAPT 
Jenkins for inclusion in this thesis. 


I extend much thanks to these two individuals. 


viii 


T INTRODUCTION 


The industrial community relies today, in increasing 
measure, upon robots to handle a multitude of tasks. A need 
remains to develop robots, and fixed robot arms, with the 
ability to roam freely among obstacles. In this regard, the 


calculation of shortest paths is of obvious importance. 


A. THE PROBLEM 

As robot arms move, they must vary their configurations to 
position their end-effector or "hand". Once obstacles are 
introduced, freedom of movement of the manipulator may become 
drastically reduced. The problem considered here is one of 
finding the shortest path from a starting point to a 
destination point in a planar region containing obstacles. 
This paper addresses several parts of the solution to this 


problem. 


B. OVERVIEW OF THE SOLUTION 

Between any two points in the plane, a path joining them 
may be chosen from an  uncountably infinite set of 
alternatives. It is desirable to choose the shortest path 
from this set which, due to the presence of obstacles, may not 
be a straight line. An exhaustive search of the collection of 
possible paths is impossible, so another method must be 


developed. 


The set of possible paths is partitioned into a collection 
of equivalence classes--mutually exclusive subsets which 
collectively exhaust the partitioned set. This Partition is 
induced when an equivalence relation is defined on the set of 
possible paths. This set of equivalence classes is countably 
infinite. 

Naming conventions are established which associate with 
each class a character string which allows the classes to be 
represented in a computer. 

Next, a finite list of candidate classes is produced to 
search. 

A heuristic is then applied to this finite list of classes 
to place them in an order which saves computational effort. 

The final step begins with this ordered list of candidate 
classes and solves the shortest path problem class by class in 
listed order. Savings of computational effort are realized 
when the class-by-class solution process can terminate without 
exhausting the ordered list of candidate classes. 

The key ideas in the above overview are now considered in 


somewhat greater detail. 


C. THE APPROACH 
1. The Topology 
Let P be the uncountably infinite set of all 
continuous, obstacle-avoiding paths from a starting point to 


a destination point, denoted a and z respectively. If P; and 


p; are two paths in P, which have the same starting point and 
destination point, we say that р; is homotopic to P; 1Ё р; сап 
be mapped to P; under a continuous function (with both 
endpoints fixed in place) without encroaching on any obstacles 
[Ref. l:p. 223]. Clearly, the homotopy relation is reflexive, 
Symmetric and transitive and therefore defines an equivalence 
relation [Ref. l:p. 223]. This relation induces a partition 
of P into a countably infinite collection of equivalence 
classes, known as homotopy classes [Ref. l:p. 223]. 
2. Establishing the Naming Convention 

In order to name homotopy classes, a reference frame 
is established to represent the topological relationships in 
the plane with obstacles. For a given path, p, a string of 
characters, R(p), is recorded which encodes information 
concerning the relationship of the path to the obstacles. 

Two algorithms are then presented which accept R(p) as 
input. These algorithms have the following important property 
which implicitly defines names for the homotopy classes: If 
p; and p; are coterminal paths and К(р.) апа R(p;) are input to 
either of the two algorithms, then the outputs are identical 
if and only if p; is homotopic to Pj [Ref. 2]. 

Chapter III presents a computational investigation 
which closely examines the methods employed by these two 


algorithms to produce the names for these homotopy classes. 


3. Generation of Names for Candidate Equivalence Classes 

An edge-labeled graph is constructed which models the 
topological relationships within the region, where the nodes 
represent subregions induced by the reference frame. Nodes 
are connected if their corresponding subregions are adjacent. 
The names of the desired homotopy classes may be obtained by 
traversing this graph. This traversal produces a list of 
candidate classes which contain all paths of minimal length. 

The location of the origin affects the manner in which 
the plane is divided into wedges. In this regard, the graph 
which is created, given the location of the origin in one 
instance, may not be the same as the graph obtained if the 
origin is moved to a new point. 

4. Heuristic Ordering of Candidate Homotopy Classes 

For each class on the list, a lower bound on the 
length of its shortest representative path is constructed. 
The list of classes is then arranged into increasing order of 
these bounds. To obtain the bounds, a point is first chosen 
within each obstacle. A contraction deformation is then be 
applied to each obstacle to "shrink" the obstacle to that 
chosen point. 

Now some class is fixed and its shortest path is 
examined. As all obstacles are simultaneously contracted to 
their representing points, this shortest path has a limiting 
position which is polygonal. The length of this polygonal 


path is the lower bound which is associated with that class. 


This length can be calculated from the class name and the 
representing points without explicitly defining any 
contraction deformation. This thesis presents this method to 
determine a bound for the shortest path in a given class. 
5. Class by Class Solution of the Shortest Path Problem 
In the final step of the solution, the classes on the 
ordered list of candidates are considered. The first class is 
removed from the list--that class with the smallest associated 
bound. The true shortest path in the named class is found by 
reversing the contraction previously applied to the obstacles, 
thereby transforming the polygonal path whose length provided 
the lower bound into the true shortest path. If the length of 
this path is smaller than the bound associated with the class 
on the top of the remaining list, the search is stopped. 
Otherwise, the first class is removed from that remaining list 
and the procedure is repeated. This procedure, which is 
contained in the thesis, continues until the condition 


specified above is met, and the shortest path has been found. 


D. Summary 

The solution to the problem of searching for the shortest 
path between two points in the plane with obstacles begins 
with consideration of a set of paths which is uncountably 
infinite. Through the homotopy relation, this set is reduced 
to a countably infinite set. The new set is further reduced 


to a finite list by modeling the region with a graph and 


applying an optimality principle. This final list contains 
only those homotopy classes containing paths which are not 
self-crossing. From this list a shortest path is found. 
Computational effort is further reduced through the use of 
a heuristic which orders the list of candidate classes by 
increasing order of their lower bounds. The heuristic used 
also facilitates a methodical search of the classes while 
solving the shortest path problem. The use of this heuristic 
does not, however, imply that the solution iS approximate. 


The solution to the problem will be exact using this method. 


E. THE CONTRIBUTION 

Chapter II of this thesis presents the methods used to 
establisha reference frame given the plane with obstacles and 
an algorithm which is used to generate the homotopy class name 
of a given path. 

Chapter III presents a computational investigation which 
addresses the question of whether or not two algorithms which 
are used to name homotopy classes actually provide the same 
results. 

Chapter IV introduces a method to find a lower bound for 
the shortest path in a class. 

Chapter V shows how to find the true shortest path in a 


class. 


II. NAMING EQUIVALENCE CLASSES 


A. INTRODUCTION 

In this chapter, a labelling scheme is established to 
represent the equivalence classes. This notation is used 
throughout the paper to organize the computational search for 
the shortest path. 

An algorithm 15 presented that for a character 
representation of a path, p, names the path's respective 
equivalence class. It can be shown that, after being 
processed by the algorithm, different character 
representations of paths P; and P; yield the same output 
exactly when and only when the two paths are in the same 
equivalence class [Ref. 2]. Thus, the name of a class will be 
the string obtained by applying the algorithm to any 
representative in the class. 

The computation of class names depends on a reference 
frame which in turn depends on a collection of obstacles. 
Although more than one reference frame can be drawn for a 
particular collection of obstacles, the choice of a particular 
frame fixes the representation of all homotopy classes. 

Once a reference frame is developed, the name of the 
homotopy class for a path can be determined by a two-step 
procedure. First, a character string R(p) is calculated which 


encodes certain information about the path taken through the 


obstacles. Second, this character string is accepted as input 
to an algorithm which then produces a name for the equivalence 
class to which the particular path belongs. This algorithm 
produces the class names in terms of the same alphabet used to 
create the initial character string. The results from the 
algorithm described, Algorithm 1, are used throughout this 


analysis as the class name associated with a given path. 


B. CONSTRUCTION OF REFERENCE FRAME 

Let b, be an arbitrary point in obstacle Бү, Ко 1.2... - 
where n is the number of obstacles in the region. A point c 
is chosen and a line drawn through each b,, infinite in extent 
in each direction and having the following properties: there 
is an open disk, 5, centered at c such that nB = g for all 
k=1,...,n, and the n lines connecting c with the points b, are 
distinct. Such a point c can always be found as the above two 
conditions are satisfied by any point in the planar region 
that is neither on an obstacle nor on the n(n-1)/2 lines 
determined by pairwise choices of distinct b,. 

To draw a reference frame, the n lines are first 
constructed joining c with each b,. The line from c to b, is 
labeled as Ly . Each line is then partitioned into two 
directed, semi-infinite rays and one finite length line 
segment. The ray directed from c in the direction away from 
b, is called ар. The ray emanating from b, and away from c is 


denoted B. The remaining line segment, [c,b,l, is also 


denoted a,. The reference frame is the collection of line 
Segments and rays so constructed, as illustrated in Figure 


El. 





Figure 2.1 A Reference Frame With n=2 Obstacles 


C. RAW CHARACTER STRINGS 

A reference frame is fixed in a region T. Let a and z be 
points in T and let p be a directed path in T from a to Ζ. 
Then the raw string of p, en ed R(p), is defined to be the 
ordered sequence of characters obtained by following p from a 
Бо 7 апа recording, іп order, the names of the rays that are 
crossed. 

Two speclal cases must be addressed so as to make the 
above definition complete. First, in the case that p crosses 
no reference rays, we let R(p) = e, where e denotes the empty 


String. Second, if p crosses through c (simultaneously 


crossing all a.) the names of all a; will be recorded in order 
of increasing subscript. 
Thus, raw strings are of the form 
R(p) s X] Xj. e Ἀν 


where each x; belongs to the alphabet 


A = (е, αι, > ат, OP e 8,). 
The character Xj (j 2-1, 2,..9998m 5 the name soit. jth 
reference ray crossed by p. Figure 2.2 shows a pair of paths 


connecting the two points a and z in the region with two 


obstacles. 





$5) α 


Figure 2.2 Paths aB, and αια] 


De ALGORITHM 1 
Algorithm 1 accepts as input a saw string Rip) τος... 
path p in T and any reference frame. The output is a string 


denoted C(R(p)) of characters also chosen from the alphabet А. 
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mys Output string С(К(р)) іс the name of the homotopy class 
mo which p belongs. 

The algorithm 1s presented in terms of two functions. The 
first is the sorting function c. Let 5 = крк Бе апу Strang 
over A. If S contains a two character substring хүхү 7 250i 
with i<j, then o(S) is the string which results by reversing 
the order of the leftmost such substring. Figure 2.3 depicts 
two such strings and makes clear that such paths аге 


homotopic. If S contains no such two character substring, 


then o(S) - S. 





Figure 2.3 Homotopic Alpha Strings оға) апа оа, 


Repeated application of c sorts all substrings that 


consist entirely of a;'s into non-decreasing order of 
Subscript. =(S) is defined to be the string which results 
when this sorting is complete. 

The second function is the cancellation function x. ШЕТ 


String S contains a two character substring хүхү,, With x; = X}; 


d 


then x(S) is the string which results by removing the leftmost 
such two character substring. Otherwise x(S) - 5. Such 
cancellation is intuitive, for a reference ray that is crossed 
twice consecutively is equivalent to one that is not crossed 
at all. Thus repeated application of x cancels all pairs of 
adjacent like occurrences of identical characters. Let X(S) 
be defined as the string which results when all such possible 
cancellation is complete. 

With these definitions complete, Algorithm l is given in 


Figure 2.4. 


begin 

Кк = 0 

S, = R(p) 

WHILE S, not equal to Х(2(5ү)) 
k - k*1 
5, - X(£(S,.))) 

END WHILE 

С(К(р)) - 5; 

ЕМГ 


Figure 2.4 Algorithm 1 
The output from Algorithm 1, C(R(p)), is called the 
canonical representation of p and is the unique name for the 


homotopy class of p [Ref. 2]. That name is used throughout 


this paper. 
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III. A COMPUTATIONAL INVESTIGATION 


A. INTRODUCTION 

This chapter describes a computational investigation which 
was conducted as an aid to verifying that the homotopy class 
names produced by Algorithm l are equivalent to those produced 
by a known method of naming homotopy classes [Ref. 2]. 

A second algorithm, Algorithm 2, is introduced here to 
forge a link between the class names of Chapter II and the 
well-known fundamental group. Two processes are presented to 
exploit this link: If Algorithm 1 truly names the classes, 
then both procedures should produce the same output for every 
path tested. One million test cases were examined and no 
counter-examples were found. While this computational 
evidence is not a proof, it did provide initial support before 
the proof of the claim that Algorithm l names homotopy classes 


was found.[Ref. 2] 


B. ALGORITHM 2 
1. Fundamental Group 
The class name obtained from Algorithm 1l was written 
in terms of the alphabet A defined in Chapter II. We present 
an algorithm here where the name obtained is expressed in 


terms of the fundamental group of a topological space T. 
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The basic idea for producing a fundamental group for 
this problem is to regard the paths in T as elements of the 
group and path concatenation (*) as the group operation. 
There are two problems with considering the paths as the group 
elements. First, it is not necessarily possible to 
concatenate any two paths in T. In order to concatenate two 
paths using the operation (*), the first path must end at the 
point where the second begins. In this analysis the test 
paths all begin and end at the point a. This point is called 
a base point and concatenation is possible for every pair of 
paths. 

A second issue is that an inverse is not well defined 
for paths. If the identity is defined as the empty string, 
і.е., stay at the base point, then when a path and its inverse 
are concatenated we have traced out a path which is not equal 
to the identity. To avoid this problem, the homotopy classes 
of paths are considered. Then all paths that have an empty 
character string representation will be in the identity class. 
Also, any class followed by its inverse will equal the 
identity. In Figure 3.1, gj represents the class aB), and 
ο, represents the class Bio). So, gj * Ge represents the 
class aB Ba) which reduces to the identity class by the rules 
of Algorithm 1. 

The group elements, therefore, are homotopy classes of 


loops around obstacles based at a common point and the group 
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operation is defined in terms of concatenation (*) of these 


classes. 





Figure 3.1 A Homotopy Class and its Inverse 


Given a base point a, we let p be any loop beginning 
and ending at a. We let [p] ο ο ος πο αποιοος class of py. 
So the set of group elements is ШЕЛІ ΠΠ; 15 a member 
peel, Where p. s a loop based at a). This set will be called 
G with the elements denoted gj- Figure 3.2 illustrates 


several paths and their homotopy classes given n=2 obstacles. 





ο ος ο Ері 2 [p] + [p] 
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Then the group operation (*) can be defined by 
(p] * Ca] = {pq]. 
It is important to note that the fundamental group is 
finitely generated. As Figure 3.3 illustrates, the generators 
are not unique. However, by fixing a set of generators, the 


class names become fixed. 





Figure 3.3 Alternate Generators For Fundamental Group of the 
Space With Two Obstacles 


With the above information describing the fundamental 


group representation апа а few necessary definitions, 


Algorithm 2 is given below. 
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2. Functions in Algorithm 
a. Side Array 
Consider the reference lines L, constructed in 
Chapter II to be oriented rays with direction from c to b,. It 
then becomes reasonable to discuss a 'right' and a 'left' side 
of those lines. A moving point is allowed to trace a path p 
from start point to destination point. Side(k) is a function 
which defines the side of L, on which the moving point lies. 
The output is either 'left' or 'right'. The output is never 
"on' because this routine is used only after a complete 
crossing of Ly takes place. A crossing 1S considered to be 
complete when the moving point leaves Ly to one side after 
having met Ly from the opposite side. 
b. Switch Function 
The switch function is defined by: 
| 'right' if side (k) = 'left' 
switch (side(k)) = 1 
ἵν. Тегі сіне (k) = 'right! 
As the moving point traces p, each time a reference line L, is 
crossed, the switch function will be applied to indicate on 
which side of L, the moving point lies. 
c. Index Function 
Let x, be any character from the alphabet A 
representing the jth element in R(p). Let index(x,) = ШЕТПЕ X, 
equals o, or B;. Thus, the kth crossing completed by the moving 


] 


point 1S a crossing of L So if the moving point is on the 


J; 
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left side of L; initially and this line is now crossed on 
either зійе ог > the side(3) would equal 'right'. 
d. The Algorithm 

Using the functions described above, Algorithm 2 
15 given in Figure 3.4. The algorithm works in two phases. 
The first phase initializes the array side(k) for k = 1,...,n. 
The second phase reads the raw string from left to right and 
adds an element to the fundamental group representation for 
each B crossing. When the end of the input string is reached, 
the output is a shorter string with one character 
corresponding to every f element in the original raw string. 


Each character represents a generator or its inverse. 


begin 
input R(p) = ХХ)... 
forf e= ντο. 
If a is to right of reference line L; then 
Side (j) — right 
else 
side (j) -~ left 
end if 
end for 
G - [a] 
for k с- 1 777700 
1 = index(x,) 
side(i) - switch(side(i)) 
if x, = B, for some r, then 
1Ё side(index(x,) ) = left, then 
GeG* gi 
else 
G = G * (gi) 
end if 
end if 
end for 
ECR Cp) mG 
end 


Figure 3.4 Algorithm 2 
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е. Fundamental Group Cancellation Function 

The cancellation rules in the fundamental group 
differ somewhat from those for the raw string. Although sets 
of generators are not unique, we can obtain a unique 
representation of each class with respect to a particular set 
of generators. For any given set of generators, every 
homotopy class can be represented as a product of these 
generators and their inverses. Even so, this representation 
is only unique after cancellation is applied. The 
cancellation rule follows. 

Let G = (41,. "= 9} be a set of generators of the 
fundamental group of T (base point a) and let Y = YiYj... Y, be 
a representation of some homotopy class in terms of the g; and 
Ен ілуегсес, ile. for each i = 1,.-5, m, y; = g; or (g,) `! 
for some j,k = 1,..., п. 

The cancellation function K is defined as follows. 
If Y contains a two character substring Yin with πα Cap 
then K(Y) is the string which results by removing both y; and 
үү, іп their leftmost occurrence, from Y. Finitely many 
repeated applications of wk produce a string in which no 
further cancellation is possible. We define this string as 


ΠΥ). 


ПӘ 


C. THE COMPUTATIONAL INVESTIGATION 
1. The Approach 
A graphical representation of the two procedures is 
provided in Figure 3.5. Тһе investigation accepts a random 
path p as input and generates two names for the homotopy class 


representing p as output. 


р 
R(p) 
ALG | AEOS? 
C(R(p)) F(RCD)) 
Anem K(F(R(p))) 
F(C(R(p))) K(F(R(p))) 


Figure 3.5 Flow Chart of Two Algorithms 


The idea of the test is to determine for a given path 
its raw string character representation. For computational 
purposes, the paths considered are polygonal paths. The raw 


string is then used as input to both algorithms. 
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τ τ; 5ἔειπα R(p) іс first inputato Algorithm 2. 
The output F(R(p)) from Algorithm 2 is then input to the 
cancellation routine and the fully cancelled string K(F(R(p))) 
is output. In parallel, R(p) is input to Algorithm 1 which 
produces the canonical string C(R(p)). Algorithm 2 is then 
applied to C(R(p)) to output F(C(R(p))). The results of these 
tests are then compared. In Figure 3.5 a flow chart 
illustrates this process. The program continues to compare 
the two outputs until a predetermined number of paths are 
checked. 

It can be shown that C(R(p)) is a unique class name if 
and only if F(C(R(p))) equals K(F(R(p))) for all p in 
T [Ref. 2]. Before the proof of this conjecture was obtained, 
the above procedures were programmed and successfully tested 
for one million different paths. 

2. The Test 

The general algorithm used to test the two procedures 
represented in Figure 3.5 is easily followed and is shown in 
Figure 3.6. However, the attached program, which was used to 
test the model, is substantially more involved. This more 
involved program was written in an attempt to generate the 


most efficient programming code possible. 
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n = number of reference frames to be considered 
m = number of paths to be considered 
nobs = number of obstacles on each board 
begin 
for board = 457 N 
create reference frame or board 
гог распа ML 
l. Create a polygonal path p with nseg 
segments 
2 Form R(p) 
3. Form F(R(p)) 
4. Form K(F(R(p))) 
5 Form C(R(p)) 
6. Form F(C(R(p))) 
if K(F(R(p))) does not equal F(C(R(p))) then 
print (raw string, board, and path info 
for the counter example) 
end if 
end for 
end for 
print (final seed) 
end 


Figure 3.6 Test Algorithm 


Two time saving techniques are employed in order to 
test the one million cases in 25 minutes. The first method 
involves the subroutines which perform cancellation. It is 
simple to code a program that scans the character 
representation repeatedly to find all possible cancellation in 
a string such as BB, aa, which reduces to В|. However, in 
the enclosed code (Appendix A), pointers are inserted in the 
strings to mark the position where the first cancellation 
occurs. Then the newly adjacent characters are checked for 
possible cancellation. This method reduces the complexity of 


the test and is employed in both Algorithm 1 and Algorithm 2. 
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The second time-saving device was developed around the 
sorting of character strings. Instead of using a bubble sort 


> complexity), a merge sort algorithm (order 


method (order n 
n(log(n)) complexity) is used. Table 1 shows the savings is 
realized immediately as opposed to there existing some cut off 


where n(ln(n)) becomes less expensive. 


TABLE 1 


COMPLEXITY COMPARISON 


2 1 

5 8 

10 23 

100 460 

1,000 6,907 
1,000,000 13,816,510 





As can be seen in the attached code, this choice to 
save computer time requires a significant increase in program 
complexity and therefore in programmer time. The trade-off of 
computer time versus programmer time needs to be considered in 
any similar analysis. 

The code used to implement the test is presented in 


Appendix A. 
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IV. DETERMINING A BOUND FOR A HOMOTOPY CLASS 


A. INTRODUCTION 

For each homotopy class on a list, a lower bound for the 
length of its shortest representative pathis found. The list 
is obtained through a graph traversal process [Ref. 3]. The 
list of classes is then arranged in increasing order based 
upon these bounds. 

To obtain the bounds, we first fix a class and consider 
its shortest path, p. For example, consider the path in 
Figure 4.1 to be a string attached at z. The shortest path is 
the one obtained by pulling the string tight so that it lies 


against the obstacles and passes through "a 


ы: 





Figure 4.1 Class Representatives 


The topological deformation of "contraction" may then be 


applied to each obstacle to "shrink" the obstacle to an point 
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b, which is choseurpbritrarily within the obstacle Ее ΙΙ. 
As seen іп Figure 4.2, when all obstacles can be 
simultaneously contracted to Doc Riese Siw pa th p found 


inlis way has a limiting position which is polygonal. 


δι 





α а 
2 α 


Figure 4.2 Class Representative to a Bound for 
the Shortest Representative 


The length of this polygonal path provides a lower bound that 
1s associated with that class. The fact that this is a lower 
bound follows from the following argument. If we let D be the 
ES t points through which paths may travel with full-sized 
obstacles and E be the set of available points in the space 
after the obstacles are "shrunk", then D is a subset of E. 
Let II(X, E) be the set of all paths in equivalence class X 
which remains entirely in E. Since D is a subset of E, II(X,D) 
is a subset of II(X,E) for all X. We now define a Func cron f 
that maps II(X,E) to a real number in R, with the rule that 
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f(p) = length of p. Since D is a subset of E, this egua ο... 


follows. 


min f(p)esman £5 | 
pell ( X, E) = pell (x, D) (Figure 4.3) 


This lower bound, minz, g) ECP). can be calculated from the 
class name and obstacle-representing points without explicitly 


defining any contraction deformation. 


| 
II(X,E) R 


Figure 4.3 Mapping Related to Class Lower Bound 


Knowing that this polygonal path, p, exists, we now give 
a method to find the minimum length path and compute its 
lengths Effectively, we must connect the points by in the 


correct order and compute the length of each line segment. 


The idea employed to find p is: We are given a starting 
point "а" апа а character string which represents’ the 
mandatory order of ray crossings. Each character of the 
string implies that we must cross a certain ray. We then 


compute the maximum number of rays (i.e. read the maximum 
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ШЫРТ ot characters іп the string) that can be crossed with 
EE T libi line. If z cannot be reached with a straight line 
we determine where it is best to make a turn. The turning 
point then becomes the new starting point and the process 
repeats until z is reached. Tos findi the straight mline 
segments of р’, the notion of a cone of directions in which 


à | | ! 
the segments of a polygonal p must lie is introduced. 


Б” FINDING THE BOUND 
1. Establishing a Cone of Directions 
The cone of directions as depicted in Figure 4.4, is 
an open region--not including the boundaries--formed by two 
rays based at a common point and forming an angle of less than 
x radians. In this region we can draw any ray based at the 
point common to the boundary rays. This is the cone of 


@rrections. 





Figure 4.4 Cone of Directions 


2. Class Name Defines the Cone 
рө сгваге айсопе we need a starting point ‘a and a 
reference ray (Figure 4.5). We define an entire class name as 


ay for a path to cross the ray сү. First we draw a ray from 


2] 


the starting point to the point representing the obstacle 
point b, In Figure 4.5, to сказет Ме тигәс Бен M E right 
of themray from a to b. The ray from "a" to b, is ος 
boundary for the cone. Next we draw a ray parallel to the ray 
that we must cross, a,. Again in Figure 4.5, in order to 
Cross a, with a straight line we must leave "a" at an angle 
that will allow us to cross the αἱ τᾶν. Therefore ӘРЕ 
parallel to αι forms the other boundary. The two boundaries 


form the cone of directions as any ray strictly lying between 


these two limits will cross сү. 


Starting 
point 





Figure 4.5 A Cone of Directions Toward αι 


3. Intersecting Multiple Cones 
Given a cone of directions for a single ray, we can 
then consider longer class name strings. For this we generate 
an intersection of multiple cones of direction. For example, 
in Figure 4.6, "a" is the starting point and the classem 


aB) B; leading to the ending point z. 
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m 
po ʻi 


Figure 4.6 The Class α) 5910) | 


nuegcsnecot directions in which the fzrst segment of 
p. must lie is determined by considering the first element of 
the class name. Therefore, the first cone must be in a 
direction which crosses the a, reference ray. 

агама іле from the starting poamt a to b, and a 
second line from "a" Бақа ео а, апа іп the same direction 
as а, (Figure 4.7). This forms the cone of directions in 


which the first polygonal line segment of the shortest 


representative must lie. 





Figure 4.7 Cone of Directions Toward 9% 
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Then we consider the second character B, and create 
the cone of directions that will in ure crossing Әс Ву. Не 
intersect the two cones of direction. The сопе of 


intersections 1S pictured in Figure 4.8. 





1 
N 
bi 52 
a 
C 
“Хә 
í a 
22 
al 
new cone Intersection 


Figure 4.8 Two Intersecting Cones of Direction 
Continuing in this fashion, in Figure 4.9, we consider the 


third character in the class, В, and create the appropriate 


Cone. 
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b, 02 
EZ 
С 
\ ἄν 
v 
a 
а, К 
] 
new cone empty 


intersection 


Figure 4.9 An Empty Intersection of Directions 


We see that the intersection of these cones is empty. 
To enter this new cone we are forced out of the cone in which 
we know the first segment must lie. Therefore, we choose a 
path which crosses all rays that were named (a, and Ву) апа 
turns on some b,. We determine the correct b, below. 

4. An Empty Intersection 

As can be seen in Figure 4.9, the new cone of 
directions lies to the right of the previous Ex сс сс сопе 
ОТ directions. This implies that the path we require will 
bend to the right. The peg--point b, on which the path bends- 
-is found on the right hand boundary of the old cone. In 
fact, as Showmin Pigure 4.9, the obstacle centered at b, is 


the peg that the path bends on in the class a,6)B8.. 


ST 


We now know that one segment of the bounding path is 
the line from a to БІ. Іп the Wex@ step we use b, as the new 
starting point. TS imee о, апа В, have been crossed, we use В, 


to create the cone of directions in Figure 4.10. 






/ z does not 


lie in the cone 


α 
| 


Figure 4.10 Cone of Directions 


Now, since there are no more characters to read, we 
check to see if z lies within the most recently established 
cone of directions. In Figure 4.10 we see that z does not lie 
іп the cone so the bounding path must bend again. 

Since z lies to the right of the cone, the bounding 
path bends on b, which is on the right hand boundary of the 
cone of directions. Hence, the final two segments of the 
bounding path are the line segments between b, and b, and the 
line segment between b, and z 

So given the class o, B, we obtain the bounding path 
pictured in Figure 4.11 on the contracted m obstac l н 


Computing the length of this path is now straight forward. 
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The next sectlon generalizes these steps and shows how 
Bind the path to 7. 


В, 





N 


a, a о, 


Figure 4.11 The Bounding Path for the Class 2,818, 


С. THE ALGORITHM 

To tind a lower bound for a path in a given class, the 
following algorithm is applied: 

He ПП аӘггау ог polnts with t(l)=a, Ππα. τίπ)Ξα; 


t(itl). through t(m-l) are pegs visited along the 
bounding polygonal path. 


peg(1) ;- the obstacle-representing point associated 
with Xi 
Someta) = the cone of directions from a starting 


point t(j) in which we can cross the ray 
Xi Wes = сатана Іі іве rome 


U :- represents the cone associated with the most 
recently read character 

У 14: = records the most recent cone of intersections 

= represents the cone of directions created by one 


character; V is assigned to vand is replaced by 
the intersection of U and ST 


L,R := represent pointers into the character string X 
and is associated with the obstacle on the left 
ος εισοας boundary of the cone of directions. If 


no boundary lies on a ray, then L or R is 
assigned zero 

Γη, δη associated with the obstacle on the lett of right 
boundary of the cone U that is intersected with 
Vola: If one ray of U lies inside Vola’ then either 
L or R is replaced by і ог Кр. I both rays of 
U lie inside Vald then L and R are replaced by Ly 
and Ry respectively. 
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BEGIN 
t(1) <-- a; 1<-- 1 
procedure START 
read character x; 
initialize current cone V <-- cone(t, xj) 
IF peg(1) on left boundary of V THEN 
L<--1; R<--0 
ELSE 
R <--i; L<--0 
END IF 
procedure CONTINUE 
1 <-- 1+1; read character xj 
U <-- cone(t, x;) 
IF peg(x;) on left boundary of V THEN 
Ly «-1 Ry«-0 
ELSE 
Ry «—-i; Ly «- 0 
END IF 
Vold <- V; Lold <-- L; Rold <-- R 
V <-- U A Vold 
IF left boundary of U falls within Vgjg THEN; L «-- Ly; END IF 
IF right boundary of U falls within Vgjq THEN; R <-- Ry; END IF 
procedure BRANCH 
IF V is empty THEN 
IF U is to left of Vgjg THEN 
j<--j+1; t Q)<--peg(Loia) 
ELSE ( U is to right of Vold ) 
)<-j+1; t ())<-- peg(Rold) 
END IF 
go to procedure START 
ELSE (V is not empty.) 
IF i « m (not all characters have been read) THEN Go to procedure CONTINUE. 
ELSE (There are no more characters to read.) 
IF zliesincurent cone V THEN j<--j+1; t(j) <--z; STOP 
ELSE 
IF U is to left of Vojq THEN 
j <--j+ 1; t(j) <-- peg(Lold); j <--j + 1; t0) <-- z; STOP 
ELSE ( U is to right of Vold ) 
j<--j +1; t(j) <-- peg(Rold); j <--j + 1; t(j) <-- z; STOP 
END IF 
END IF 
END IF 


END IF 
END 
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V. FINDING THE SHORTEST PATH 


A. INTRODUCTION 

In order to find the true shortest path from a to z we 
consider the classes of paths on the ordered list of candidate 
paths. We proceed by removing the first class from the list. 
The true shortest path in the named class is found. If the 
length of this path is smaller than the bound associated with 
the class on the top of the remaining ordered list, the search 
is stopped. Otherwise, the first class is removed from the 
remaining list and the above procedure is repeated. This 
continues until the true shortest path is found. 

To find the shortest path within a given class, we reverse 
the contraction applied to the obstacles performed earlier 
when we found the lower bound for the classes (see Figure 
5.1). For each polygonal path, whose length provided a lower 
bound, we transform the segment into the true shortest path in 
that class. Accordingly, the process of calculating the 
shortest path in a class begins with the polygonal path used 
to lower bound it and a description of the obstacle 


geometries. 
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Figure 5.1 Reversing the Obstacle Contraction 


To this point, no assumptions have been made about the 
shapes of the obstacles. In this chapter, with little loss of 
generality and for computational purposes which will be 
discussed later, all obstacles are assumed to be circles 
centered on b; . We could, of course, assume other shapes, 


like polygons or ellipses. 


B. FINDING LINE SEGMENTS 

As can be seen in Figure 5.2 the line segment From cud ии 
is tangent to B. Also, the line segment trom В) (СС 
obstacle B, is tangent to both obstacles. In general there 
are two tangent lines from a point to a circle and there are 
four distinct lines tangent between two circles (see Figure 
5.2). In this section we see how to find these tangent lines 
and we show how to pick the correct tangent line to represent 


the true shortest path in the class. 
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Figure 5.2 Possible Tangent Lines 


Assuming that the shortest path from a to z in a given 
class of paths is not a straight line, we use another 
application of the cone of directions idea to determine on 
which side of an obstacle to turn. That is equivalent to 
picking the correct tangent line. We use the last cone of 
intersections formed just before the intersection of cones 
becomes empty to make this determination. 

In Figure 5.3 we see that the path is required to bend 
around obstacle Bi. ТЕ а tangent line is drawn from a to the 
left side of obstacle 1 and we then travel on an arc around 
the obstacle until we can proceed directly to z, we would have 
the shortest path in the class and could easily find its 


length. If not then we iterate the process. 
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œ] 
Figure 5.3 Path Bend in Class В, 


Тһе following method is used to find the tangent lines to 
a circular obstacle when given the starting point, the 
coordinates of the center of the obstacle, and the radius of 
the obstacle. 

In Figure 5.4, the starting point, a, is the point (ue 
The center coordinates and the radius of the peg are the point 


(h,k) and r, respectively. 
y 





a (u,v) 
Figure 5.4 Point to Obstacle Tangent Lines 
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With this information we determine the equations of the 
clrcle representing the obstacle and an arbitrary line. Ме 
solve these equations simultaneously for the points of 
intersection (Figure 5.5). The specific value that we want is 


the point of tangency. 


Figure 5.5 The Intersections of a Circle and a Line 


So, given h, k, and r and assuming, without loss of 
generality, that b=u=v=0, we find the following two equations: 
CD DAE M REL 
y - mx (where m is the slope of the line) 
By expanding the first equation and substituting y=mx we 
pbtain: | 
(1+m*)x* + (2mk-2h)x * (h*t*tk*-r*) - O 


By the quadratic formula we obtain: 


-2mk*2hs [ (2mk-2h) 2-4 (1 em) (2-12) 1% (1) 


μα 2 (1 +IP) 


In Equation (1), if the discriminant is zero, we have found 
the value where the points of intersection coincide. So 


setting the discriminant equal to zero yields: 
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(=2h=2 km)*-a πο "κα. 0 
(A*km)?- (n£*1) (E2*k*-r?) =0 
(k?m?*2hkm*1?) - (n£*1) (124 k?-r?) 20 
( ke— h°— kë+ r2) r+ (2 hk) m* (z?-k*) 20 


from which m can be determined. 


A second appllcation of the quadratic formula produces: 


-2hk+ [4h2k2-4 (r2-h2) (r2-k®) ]* 


шім 2 (r?-H) 
_ -hk+r[hb2+k2-r2J% ._ 
т; = a , 11, C 


In general, with an arbitrary u and v 


_ -(h-u) (k-v)+r[(h-u)2+(k-b)2-r2)% 
° r?- (h-u)? ' 


i=1,2 

The only time this technique does not appear to work is 
when the tangent line found is a vertical line (m is undefined 
because there is a zero in the denominator). This problem can 
be easily handled because if m is undefined we know the 
equation for a vertical line to be x equal to some constant. 

The value for m is then substituted into Equation (1) to 
find the Xj, 1 = 1,2, coordinate and the value of x, is 


1 
substituted into yi = mx to πο ME knowing on which side 
of the obstacle the path must turn, we can pick the tangent 
line with the appropriate slope. A method of picking the 


correct line will be discussed in the next section. 
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ПКО ОО е а с а опа the circle to the point of 
tangency of the line between the current obstacle and z or to 
the point of tangency to the next obstacle. Tangent lines 
between two obstacles can be determined by a similar method as 
the one just shown. A method of finding the four tangent 


lines between two circular obstacles follows. 


C. DETERMINING THE CORRECT TANGENT LINES 
1. Point to Obstacle 

We have shown how to find the two tangent lines from 
a point to a circle. We present a method to determine which 
tangent line to pick. 

The obstacle on which we turn lies on a boundary of 
the cone of directions. Thus the cone itself lies either to 
the left or to the right of the ray through the obstacle 
center. If the cone lies on the left, use the tangent of the 
left is taken. If the cone lies to the right, then the 


tangent on the right is taken. The case with the cone on the 


Mert τε illustrated in Figure 5.6. 


В 


l 





(Me Correc 
tangent 
line 
] 
Figure 5.6 Use the Left Tangent for Path Bending to the Right 
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2. Obstacle to Obstacle 

When considering two circular obstacles, there are 
four distinct lines that can be drawn tangent to both 
obstacles. In this section we show how to pick the tangent 
line that corresponds to the respective shortest path in the 
given class. 

To find the four distinct tangent lines between two 
obstacles we first create a line which is tangent to one of 
the circles. We then move this tangent line along the circle 
boundary until we discover the four points at which the line 


is tangent to both obstacles (Figure 5.7). 


(X V ) 


& |2 (Х,У) -(г со5(0), г віп(ф)) 


Figure 5.7 Rotating @ to Find Tangent Lines Between 
Two Circles 
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Without loss of generality, in Figure 5.7 we fix one 
obstacle center at the origin. We pick an arbitrary point 
EN) оп the obstacle B, represented as (rv*cos(%), 
r*sin(@)). We construct a line through (x',y') tangent to В). 


The slope m of this line is: 


y-r*sin(@) 


x-r*cos (4) 


This slope is also equal to -cot($). Hence, 
m = y-r*sin$ = -cot (@) (2) 
х-гжсозф 


The equation of the circle with center (h,k) is 


(x-h)*+(y+k)? = R2 


Rearranging Equation (2) we obtain the following: 


y - r*sin($) = (-cot(@)) (x - r*(cos (®) ) (3) 


y = (-cot(@))x + r*cos() *cot($) + r*sin(%) 


Equation (3) is in slope-intercept form and the y intercept b 


15: 
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o 
i 


I*cos ($) «cot (@) % іжвіп(ф) 


I E * віпф) | 


Sin 


т | cos?$ - aj 


sind 


ty 
n 


r*csc(%$) 


Thus both m and b are functions of @. “he general line that 


we use to intersect both circles is 


у = т(ф) х % Ь(%) 


This equation for the line and for the obstacle centered at 
(h,k) are solved simultaneously. After steps similar to those 
used in the point to obstacle example we obtain the following 


formula: 


(nP+1) x® + [-2h+2m(b-k)]x + [h®+(b-k)#-R*®] = 0 


Again by applying the quadratic formula and setting the 


discriminant equal to zero we find 


4 [-h-m(b-k)]? - 4 (mê+1) [H+ (b-k)?-R] = 0 


Substituting the function values for m(@) and b(@) yields 


І-Һ-(соғф) (гжсвсф-К)12%-(со%%ф»1) (ІР (r*csch-k)2-FR®] =0 (4) 


ая 


πο ντος bas four zeros for values of @& in [0,2x) 


ав can be seen in Figure 5.8. 





Figure 5.8 Four Zeros of Equation- (4) 


Since $ is the only parameter in Equation (4) we can 
use the four values found to label the four tangent lines. 
The line M CES E with the lowest value of ọọ is labeled A, 
the second line associated with the second lowest ф value is 
labeled B and the last two lines are labeled with C and D, 


respectively. 
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Figure 5.9 Possible Tangent Lines 


Assuming the polygonal path bends on each peg on the 
path, there are essentially two possible arrangements when 
considering a polygonal path that negotiates two obstacles. 
These possibilities are shown in Figure 5.10. The paths can 
be flipped about the horizontal axis to produce two equivalent 


paths. 





Figure 5.10 Two Possible Polygonal Paths 
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Invorder to discover which situation exists, we extend 
the middle line segment and use it as a reference in Figure 
5.10. Since the path bends at each peg, the two end segments 
must lie on one side or the other of the reference line. If 
they both lie on the same side, then we have situation a 
above. If the two segments lie on opposite sides, then we 
have situation b. 

Given the two possible arrangements in Figure 5.10, we 
know the corresponding shortest paths in the class look like 


those in Figure 5.11. 


Figure 5.11 True Shortest Paths 

We have shown how to pick the correct tangent line 
ШӘ a point to a circle. This is applied to find the first 
and last segments of this polygonal path. 

To find the correct tangent between two obstacles, 
following the situation on the left in Figure 5.11 we must 
pick tangent line B, described earlier. If we have the other 
situation in Figure 5.11, we must pick tangent line A. 

If the polygonal path does not bend on each peg, then 


there are two possible configurations as seen in Figure 5.12. 
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Figure 5.12 Polygonal Paths With Collinear Segments 


To this point, we only used the cone of directions 
idea to find the correct tangent from a point to an obstacle. 
We use the cone of directions information to pick the correct 


tangent lines too. 


As seen in Figure 5.13 we consider the class βια). 





a 
bound 
true 
Figure 5.13 Class Bia, and its Bounds 
The tangent line from a to Bi is found in the same 
manner as discussed earlier. However, since the path of the 


bound does not bend, we cannot choose the correct tangent line 
between В, апа В, in the same way as before. 

Instead, we construct a reference line that connects 
the centers of the two obstacles. Then we consider on which 


side of this line the cones of directions lie (Figure 5.14). 
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If they lie on different sides of the reference line then we 
pick tangent line A or D. Otherwise, we pick tangent lines B 


or С. 





ΕΠΗ, 
intersection 


9, 


Figure 5.14 Cone of Direction to Help Pick Tangent Lines 


D. TWO POTENTIAL PROBLEMS TO CHECK 

Given a path in a class like the one in Figure 5.15, we 
see the associated bounding path when we shrink the obstacles 
to points. However, there are two separate problems that may 
arise when the obstacles are restored to their original shape: 
1) The prospective path may pass through one or more 
obstacles. 2) When the obstacles are restored to their full 
size the path created can switch sides of one or more 


obstacles. These possibilities can be seen in Figure 5.16. 
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Figure 5.15 A Class and Its Bounding Path 


50 


— — — ақы — — 


the bounding 
path 





Figure 5.16 A Bounding Path and Its Restored Path 


The path determined by the cone of directions technique 
passes through obstacles Bj and Br, illustrating the first 
ШОО ет “Еу switching sides of B,, the path is no longer in 
the same equivalence class, illustrating the second problem. 
Actually, the path should look like the one in Figure 5.17 


emeh avoids all obstacles and remains in the original class. 
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Figure 5.17 Corrected Shortest Path 


The correct path around the obstacles can be determined by 
using a distance function. Then, methods discussed in Chapter 
IV are employed to negotiate the new impeding obstacles. In 
Figure 5.18, segment Р, --which is one segment of the bounding 
path--joins pegs by and ЫН. and lies along the line through 


these pegs. We let a circular obstacle B, have center (u;,v;) 
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and radius г;. Pegs b, and bu] have cartesian coordinates 
Muy.) and (πμ. respectively. We let d(*,*) denote 
Euclidean distance. 

The distance from p. to B; which is the perpendicular 


] 
distance from p. to the nearest point in B;--is діуеп by 
d(p, ,Bj) if the center of B; lies in the band denoted in Figure 
5.18 whose borders are perpendicular to p. and which passes 
through b, and br]: and by min{d(b,,B;),d(b,,),B;)} if not. We 
can then check whether the center of B; is in the band if we 


define vectors 
Ai = (Ex xi], [yar yil) 
and 


ΕΠ (Lu,-xi J, [v7 Y; 1) 


which can be seen in Figure 5.19 [Ref. 5]. 
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Figure 5.18 Band Created By One Segment of a Polygonal Path 
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Then the center of B, is in the band if and only if m Hy.) 570 


and À; . ui; 0, where (:) denotes the inner product. We write 


the distance function corresponding to D. passing through B; 


as 


díps,bs4) 20 and Mm 
“q p ss ШЕ 


min d(b,,B,) ,d(b,.,, B;) ; otherwise 


These distances are easily computed with 


d(b,,,,B,) m [ (x;7u4)? Т (Уу-уу) 2] = Pg 
and 


d(p,,B,)= СУ УМУ: — (ху =х un ume У: (х,17Х;)! A 
Ton [Gra 7y02 *. 4 7x,)21* д 


ГБет, 51 





| t 
Figure 5.19 Vectors to Help Determine d(p, ,B;) 
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With this new information, appropriate tangent lines must 
be found in order to avoid newly-violated obstacles and to 
keep the path in the correct class. These new tangent lines 
may also encroach obstacles. So the process of checking all 
obstacles is continued until no obstacles are violated. 

To find the length of the shortest path, we sum the 
straight line segments апа а11 of the are lengths 
corresponding to the distances traveled around each circular 


obstacle. 
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VI. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

Determination of the shortest path between two points in 
a plane containing obstacles has applications in many fields, 
particularly that of robotic path planning. This thesis 
addresses several key issues belonging to a larger plan for 
the solution of the shortest path problem. This plan may be 
summarized as follows: 


Partition the set of paths into homotopy classes. 

Associate algebraic "names" with each of these classes. 

Produce a finite list of feasible classes. 

For each class on the above list, calculate an 

inexpensive lower bound on the length of its shortest 

path. 

5. Arrange the list in increasing order of these lower 
bounds. 

6. Considering the classes in listed order, calculate the 

Shortest path in the class. Calculation terminates when 

some class is encountered whose shortest path has length 

Shorter than the lower bound associated with the 

succeeding class. 


Ф WW N = 


The approach outlined above offers two primary 
computational advantages. First, note that the collection of 
possible paths from a given point of origin to a given 
destination is uncountably infinite. By organizing the search 
around homotopy classes and by taking advantage of certain 
topological relationships in the region [Ref. 3], the search 
of an uncountably large set is replaced by a search of a 


finite list. 
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Second, the search of this finite list is ordered 
according to lower bounds which estimate the lengths of the 
associated shortest paths. This ordering allows the search to 
terminate without exhausting the list. The bounds associated 
with each class are inexpensive to calculate--relative to the 
cost of finding the class' shortest path. This results in 
further savings of computational effort. 

The contributions of this thesis concentrate in areas 2, 
4, and 6 of the above list. 

As regards the association of names with homotopy classes 
(area 2) we present a computational investigation which was 
conducted ancillary to proof activity in this area. In 
summary, we associate a name with each homotopy class as 
follows: by imposing a certain labeled reference frame on the 
region in question; by encoding information about the 
relationship of a given path with the frame; and by employing 
algorithms presented here. In this way, we reduce the encoded 
information to a string of characters which is unique to each 
class. The investigation presented here uses a presentation 
of the well-known fundamental group as a standard of 
comparison to verify that the character strings used in our 
approach are in fact class names. (This proposition has 
subsequently been proved [Ref. 2]). Тһе significance of the 
structure of the names which we employ is that they 


incorporate information which is useful both for the 
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calculation of class bounds and for calculation of class 
shortest paths. 

For the calculation of class bounds (area 4) we represent 
each obstacle by a point chosen within it. This point is used 
to construct the reference frame which is imposed on the 
region. Restricting our attention to such summary information 
allows class bounds to be calculated cheaply. 

The final step (area 6) begins with an ordered list of 
classes. In this paper we present a method by which shortest 
paths of a class may be calculated when the obstacles are 
circular. This is the only step in which any generality is 


lost, and is potentially fruitful subject for further study. 


B. RECOMMENDATIONS FOR FURTHER STUDY 

The field of robotics is one that is gaining much interest 
in mathematics and other fields of study. Further analysis of 
the reference frame and its properties may aid future 
researchers in answering other questions concerning the 
shortest path problem. 

One aspect of the problem that can be studied further 
relates to areas 4 and 6 above. Programming the two steps of 
finding the lower bound for a class and subsequently 
determining the shortest path in a class would be quite 
useful. 

Another computational problem relates to area 2. It is 
believed that further study and refinement of the code could 
result in a program which is even more efficient. 
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Another possible subject of future research is that of 
considering non-circular obstacles (area 6). It should be 
noted that any set of obstacles can be covered with circles. 
With this approximation the procedures presented in this 
thesis may be applied. 

Finally, this thesis introduces only part of the solution 
to the shortest path problem. The thesis by CAPT Kevin D. 
Jenkins, U.S. Marine Corps [Ref. 3], presents the remaining 
portions of the solution (area 3), and should be studied in 


conjunction with this paper. 
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APPENDIX A. FORTRAN PROGRAM: THE COMPUTATIONAL INVESTIGATION 


PROGRAM CLASNAME FORTRAN 


A RR ATCC BE IR Xo ace tote ae caca 3k 3k s o oe ee 3k OR AR o oe arcc ke oec oic ace oc ap o m or RRR oro Жжжж or 
THIS PROGRAM RANDOMLY GENERATES OBSTACLES AND A POLYGONAL PATH 
THROUGH THOSE OBSTACLES TO DETERMINE WHETHER OR NOT THE PROCEDURES 
USED BY COMPETING ALGORITHMS PRODUCE THE SAME FUNDAMENTAL GROUP 


REPRESENTATION FOR THAT PATH. 
ЖС oe cooks oco oon eoe ce xc ac e orc xc ke c sie e occ doe cle e aed ole sie oe ae oec oe o ke ooo a ao A a a ae ak + 


THIS PORTION OF THE PROGRAM SERVES AS THE MAIN DRIVER WHICH RECEIVES 
THE PARAMETERS DEFINING THE REGION AND INITIALIZES THE LINK LIST 
ARRAYS WHICH WILL BE USED TO REPRESENT THE POLYGONAL PATH. 


INPUT: INITIAL SEED FOR THE RANDOM NUMBER GENERATOR, NUMBER OF 
OBSTACLE CONFIGURATIONS AND PATHS TO BE TESTED, NUMBER OF 
OBSTACLES IN THE PLANE AND NUMBER OF SEGMENTS IN EACH 
POLYGONAL PATH 


OUTPUT: FINAL RANDOM NUMBER GENERATOR SEED AND MESSAGES INDICATING 
ANY PATHS WHICH PRODUCE DIFFERENT FUNDAMENTAL GROUP 
REPRESENTAT IONS 


REAL*8 BX(1000), BY(1000), X(1000), Y(1000), DSEED 
INTEGER МОВ5, NSEGS, NUMPTS, N, M, HEAD( 1000) 
+ NEXT(1000), PRED(1000), BOARD, PATH 
EXTERNAL GGUBFS 


DSEED = 123457.0 


20 

5 

NSEGS + 1 

INPUT SEED', DSEED 


МОМРТ5 
PRINT*, 


22 

с 

В 
-H H Hl 


DO 1 BOARD = 1, N 
CALL BOARDS (DSEED, BX, BY, NOBS) 
DO 2 PATH = 1, M 
CALL INIT (HEAD, NEXT, PRED, PSEED, DSEED ) 
CALL PATHS (DSEED, X, Y, NSEGS) 
CALL TEST(HEAD,NEXT,PRED,BX,BY,NOBS,X,Y,NUMPTS , BSEED , PSEED) 
2 CONT I NUE 
1 CONTINUE 


PRINT*,' ' 
PRINT*,'FINAL SEED', DSEED 


STOP 
END 
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SUBROUTINE INIT ( HEAD, NEXT, PRED , PSEED, DSEED) 


kkkkkk kkk kk kkk kkk kkk kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkķkkkkxkx 


THIS SUBROUTINE INITIALIZES THE DOUBLE LINK LIST ARRAYS THAT WILL 
REPRESENT THE PATH. 


INPUT: DSEED 


OUTPUT: HEAD, NEXT, AND PRED ARRAYS SET TO ZERO, AND SEED FOR THE 
R.N.G. PRIOR TO CONSTRUCTION OF THE PATH 


INTEGER HEAD( 1000), NEXT(1000), PRED( 1000) 
REAL*8 PSEED, DSEED 


PSEED = DSEED 


DO 3 K = 1,1000 
HEAD(K) 
NEXT(K) 
PRED(K) 

3 CONTINUE 


Hon HI 


0 
0 
0 
RETURN 


END 


SUBROUTINE BOARDS (DSEED, BX, BY, NOBS) 


3 X cock ok ek oco kc kc oc i oko seo oc ok oc oc eo oe oe oc coc oe xc e oce cocco IC 2 ac xoc coke xoc oe oe xo ox oro doe 


THIS SUBROUTINE USES A PSEUDO RANDOM NUMBER GENERATOR TO CREATE THE 
COORDINATES OF EACH OBSTACLE ON THE BOARD, SCALING ALL COORDINATES 
TO BE IN THE INTERVAL (-1,1). 
INPUT: NUMBER OF OBSTACLES IN THE REGION AND A SEED FOR THE R.N.G. 
OUTPUT: OBSTACLE COORDINATES 


REAL*8 BX( 1000), BY( 1000), DSEED 
EXTERNAL GGUBFS 


DO 1| - 1, NOBS 
BX(I) - 2. * G3JUBFS(DSEED) - 1. 
1 BY( 1) = 2. * GGUBFS(DSEED) - 1. 
RETURN 
END 
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SUBROUTINE PATHS (DSEED, X, Y, NSEGS) 


АЖК КУ Ж Ж ХХ ЖЕЖ ЖА ЖКЖ ЖЖ Ж ЖЖЖЖКЖЖЖА ЖЖЖ ЖЖЖЖЖЖ ЖЖЖ 3 k KK k k Ioa 


ОООО 


O 
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RANDOMLY GENERATES THE X AND Y COORDINATES OF THE VERTICES FOR THE 
POLYGONAL PATH, SCALING ALL COORDINATES TO BE IN THE INTERVAL (-1,1). 
THIS SUBROUTINE ALSO ENSURES THAT THE PATH IS A CLOSED LOOP BY 
ASSIGNING THE START/FINISH POINTS THE SAME COORDINATES. 


INPUT: NUMBER OF PATH SEGMENTS AND A SEED FOR THE R.N.G. 
OUTPUT: COORDINATES OF VERTICES ALONG THE POLYGONAL PATH 


REAL*8 X(1000), Y(1000), DSEED 
EXTERNAL GGUBFS 


DO 1 | = 1, NSEGS 
X(1) = 2. * GGUBFS(DSEED) - 1. 
1 Y(1) = 2. * GGUBFS(DSEED) - 1. 
X(NSEGS+1) = X(1) 
Y(NSEGS+1) = Y(1) 
RETURN 
END 


SUBROUTINE TEST(HEAD, NEXT, PRED, BX, BY, NOBS, X, Y, NUMPTS, 
+ BSEED, PSEED) 


EAI ACT REE HCE IK HC IE IRC HE IK EA jc ke ook oe HE RCE IK HEI RCE I CAC RCAC I HE IC IRC RE AE IE RC IR RCA IK A kok kk ok kok A IK IK IK KC AK IK A 


GENERATES THE RAW STRING OF CHARACTERS REPRESENTING A PATH AND 
DETERMINES ITS FUNDAMENTAL GROUP REPRESENTATION USING ALGORITHMS 1 
AND 2. RESULTS OF THESE COMPETING ALGORITHMS ARE THEN COMPARED FOR 
DIFFERENCES. 


INPUT: A POLYGONAL PATH AND COORDINATES OF POINTS REPRESENTING 
OBSTACLES 


OUTPUT: COMPARED RESULTS OF ALGORITHMS 


INTEGER HEAD( 1000), NEXT( 1000), PRED( 1000), FR( 1000), NR(1000), 
+ PR( 1000), FL( 1000), NL(1000), PL( 1000) 
REAL*8 ВХ( 1000), ВҮ(1000), Х(1000), Ү( 1000) 


DATA FR/1000*0/ 
DATA NR/1000*0/ 
DATA PR/1000*0/ 
DATA FL/1000*0/ 
DATA NL/1000*0/ 
DATA PL/1000*0/ 
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CALL RAWSTR(BX, BY, NOBS, X, Y, NUMPTS, HEAD, NEXT, PRED, NELEMS) 
CALL ALG2 (NOBS, NELEMS, HEAD, NEXT, X, Y, BX, BY, FR, NR, PR) 
CALL CANALG2 (FR, NR, PR) 

CALL ALG1 (HEAD, NEXT, PRED, NELEMS) 

CALL ALG2 (NOBS, NELEMS, HEAD, NEXT, X, Y, BX, BY, FL, NL, PL) 
CALL CTREX (FE, NL, PL, FR, NR, PR, BSEED, PSEED) 


RETURN 
END 


SUBROUTINE RAWSTR(BX, BY, NOBS, X, Y, NUMPTS, HEAD, NEXT, PRED, 


+ NELEMS ) 
SEAR IARI RRR RIAA IK AK ok ke ek EK 


PRODUCES THE RAW STRING OF CHARACTERS WHICH REPRESENTS THE PATH, 
PAYING CLOSE ATTENTION TO THE ORDERING OF THE CHARACTERS WHERE 
NECESSARY. THE STRING IS CONSTRUCTED BY IDENTIFYING THOSE OBSTACLE 
REFERENCE LINES WHICH ARE CROSSED AS EACH PATH SEGMENT IS TRAVERSED 
IN ORDER. 


INPUT: ORDERED LIST OF VERTICES REPRESENTING THE PATH AND A POINT 
REPRESENTING EACH OBSTACLE IN THE REGION 


OUTPUT: A RAW STRING OF ALPHAS AND BETAS CONTAINED IN AN ARRAY 
NAMED HEAD() AND ITS PARALLEL ARRAYS NEXT() AND PRED() WHICH 
PRODUCE THE DOUBLE LINKED LIST 


IMPLICIT REAL*8 (A-H,O-Z) 

INTEGER HEAD, NEXT, SEG, FSTSTR, HDINDX, SEGEND, FIRST, START, 
+ LENGTH, PRED 

LOGICAL ALLALF 

DIMENSION X(1000), Y(1000), BX(1000), BY(1000), A1(1000), 
+ B1(1000), A2(1000), B2(1000), D2(1000), DIST(1000), 
+ FIRST(1000), HEAD(1000), NEXT(1000), PRED(1000) 


DATA DIST/1000*0.0/ 
DATA FIRST/1000*0/ 


CALL SETUP(NUMPTS , NOBS,CX,CY ,X,Y,BX,BY,A1,B1,A2,B2,D2) 


HDINDX - 2 
NSEGS - NUMPTS - 1 
LOLD = 1 


HEAD(LOLD) = 0 
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DO 7 SEG = 1, NSEGS 


SEGEND = SEG + 1 
FSTSTR = HDINDX 

LSTSTR = HDINDX 

ALLALF = .TRUE. 

LENGTH = 0 


DO 6 LINE = 1, NOBS 
CHECK1 = (A1(LINE)*X(SEG)+B1(LINE)*Y (SEG) )* 


+ (A1(LINE)*X(SEGEND)+B1(L INE )*Y( SEGEND ) ) 
IF (CHECK1.LT.0) THEN 
LENGTH = LENGTH + 1 
CHECK2 = (A2(SEG)*BX(LINE)+B2(SEG)* 
+ BY(LINE)+D2(SEG) )*D2(SEG) 


IF (CHECK2.LT.O) THEN 

HEAD(HDINDX) = -LINE 

LSTSTR = HDINDX 

HDINDX = HDINDX + 1 
ELSE 

CALL САЅЕ51 (А1, B1, A2, B2, D2, SEG, LINE, XINT, 
+ YINT) 
DISTC = XINT**2 4 YINT**2 
DISTB = (XINT-BX(LINE))**2 + (YINT-BY(LINE) )¥*2 
IF (DISTB.LT.DISTC) THEN 

HEAD(HDINDX) = LINE 


LSTSTR = HDINDX 
HDINDX = HDINDX + 1 
ALLALF = .FALSE. 


ELSE 
HEAD(HDINDX) = -LINE 
LSTSTR = HDINDX 
HDINDX = HDINDX + 1 
ENDIF 
ENDIF 
ENDIF 
CONT | NUE 
IF (LENGTH.NE.O) THEN 
IF (ALLALF) THEN 
CALL ALPHAS (NEXT, LOLD, FSTSTR, LSTSTR, SEG, START, 


+ HEAD, NSEGS, PRED) 
ELSE 
CALL ORDER(SEG, LINE, HDINDX, HEAD, NEXT, Al, A2, 
T B1, B2, D2; FSTSIR, CSTSTR;, X M T TARIE 
+ LENGTH, FIRST, LOLD, NSEGS, PRED) 
ENDIF 
ENDIF 


CONT I NUE 
CALL COUNTR(START, NEXT, HEAD, NELEMS) 


RETURN 
END 
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SUBROUTINE SETUP(NUMPTS, МОВ5, СХ, СҮ, Х, Ү, ВХ, ВҮ, А1, В1, А2, 
+ B2, D2) 


MEA ER RK RK IK KK AK EK RK A RE KK EK EK KK KR A KK AE RE EE EK OK EE AE OK OK RR KK EE EK AK OK RK OK OK KK KKK 


FOR EACH OBSTACLE, THIS ROUTINE DETERMINES THE COEFFICIENTS OF THE 
EQUATION FOR THE REFERENCE LINE FROM THE OBSTACLE TO THE ORIGIN. ΙΝ 
ADDITION, IT CALCULATES THE COEFFICIENTS OF THE LINE REPRESENTING 
EACH SEGMENT OF THE POLYGONAL PATH. 


INPUT: NUMPTS, NOBS, COORDINATES OF VERTICES ALONG POLYGONAL PATH 
AND COORDINATES OF THOSE POINTS WHICH REPRESENT EACH 
OBSTACLE 


OUTPUT: COEFFICIENTS OF LINEAR EQUATIONS REPRESENTING PATH SEGMENTS 
AND REFERENCE LINES FOR EACH OBSTACLE 


IMPLICIT REAL*8 (A-H, O-Z) 
DIMENSION X(1000), Y(1000), BX(1000), BY(1000), A1(1000), 
+ B1(1000), A2(1000), B2(1000), D2(1000) 


DO 4 | = 
А1(1 
B1(I 

4 CONTINUE 


1, NOBS 
) - BY(I) 
) = -BX(1) 


Q Q 


0.0 
C 0.0 
| = 1 


DO 5 J = 2,NUMPTS 
Αρ πο) = YC) 


B2(1) = X(1) - X(J) 
D26l ) : (YCI)*X(J)) -CXC1 )*Y (2)) 
| = l+ 
5 CONTINUE 
RETURN 


END 
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SUBROUTINE CASES1(A1, B1, A2, B2, D2, SEG, LINE, XINT, YINT) 


CO Xo xoxo oec coe dose oe cor ac deo oe oco ac occ cook oco eoe deo oic tog x xc oko RAC eon xo 
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THIS SUBROUTINE DETERMINES THE COORDINATES FOR THE POINT OF 
INTERSECTION OF A GIVEN PATH SEGMENT AND A GIVEN OBSTACLE REFERENCE 
LINE. NUMERICAL STABILITY OF CALCULATIONS REQUIRES THE MATHEMATICAL 
OPERATIONS TO BE SEPARATED INTO CASES, THE BEST CASE BEING USED FOR 
EACH PARTICULAR SITUATION. 


INPUT: COEFFICIENTS OF LINEAR EQUATIONS FOR PATH SEGMENT AND 


REFERENCE LINE TO BE EVALUATED 


OUTPUT: POINT OF INTERSECTION OF THE PATH SEGMENT AND THE OBSTACLE 


REFERENCE LINE 


IMPLICIT REAL*8 (A-H,O-Z) 
INTEGER SEG 
DIMENSION A1(1000), B1(1000), A2(1000), B2(1000), D2(1000), A(2,2) 


A(1,1) = A1(LINE) 
A(1,2) = B1(LINE) 
A(2,1) = A2(SEG) 
A(2,2) = B2(SEG) 
BIGEST = 0.0 
DO 1 L = 1,2 
DO 1K = 1,2 
TEST = DABS(A(K,L)) 
IF (TEST.GT.BIGEST) THEN 
BIGEST = TEST 
KBIG = к 
LBIG = L 
ENDIF 
СОМТІМОЕ 


IF (KBIG.EQ.1) THEN 

IF '(LBIG:EQ 1) TEN 
YINT - -D2(SEG)/(B2(SEG)-B1(LINE)*A2(SEG)/A1(LINE)) 
XINT = -B1(LINE)¥*YINT/A1(LINE) 
RETURN 

EESE 
XINT - -D2(SEG)/(A2(SEG)-A1(LINE)*B2(SEG)/B1(L | NE) ) 
YINT = -A1(LINE)*X!INT/B1(LINE) 


IF (LBIG.EQ.1) THEN 
YINT = (D2(SEG)*A1(LINE)/A2(SEG) )/ 


+ (B1(LINE)-B2(SEG)*A1(LINE)/A2(SEG)) 


XINT = (-D2(SEG)-B2(SEG)*YINT)/A2(SEG) 
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ELSE 
XINT = (D2(SEG)*B1(LINE)/B2(SEG))/ 

(A1(LINE)-A2(SEG)*B1(LINE)/B2(SEG) ) 
YINT = (-D2(SEG)-XINT#A2(SEG) )/B2(SEG) 
RETURN 

ENDIF 


ENDIF 


END 


SUBROUTINE ALPHAS (NEXT, LOLD, FSTSTR, LSTSTR, SEG, START, HEAD, 
NSEGS, PRED) 


Ao aco coe c oe ЖЕЖ ЖЕ ЖКЖ ЕЖ ЖЖЖ ЖЖЖ RC YC ЖЖЖ eos acc de о 


GIVEN THAT A SEGMENT OF THE PATH CROSSES ONLY ALPHA RAYS WHEN 
TRAVERSED, THESE CROSSINGS ARE SIMPLY INSERTED INTO THE LINK LIST 
ARRAYS IN THE ORDER IN WHICH THEY WERE DETECTED, I.E., SMALLEST Το 
LARGEST IN ABSOLUTE VALUE. 


INPUT: STRING REPRESENTING THE REFERENCE LINES CROSSED BY THE 


CURRENT PATH SEGMENT, GIVEN THAT ALL CROSSINGS ARE ALPHAS 


OUTPUT: UPDATED NEXT() AND PRED() ARRAYS WHICH CONTAIN THE STRING 


12 


REPRESENTING THE MOST CURRENT PATH SEGMENT 
INTEGER NEXT(1000), FSTSTR, SEG, START, HEAD(1000), PRED( 1000) 
NEXT(LOLD) = FSTSTR 
PRED(FSTSTR) = LOLD 
LAST = LSTSTR - 1 


IF (LAST.GT.FSTSTR) THEN 


DO 12 | = FSTSTR,LAST 
МЕХТ(І) г І 41 
PRED(I*1) = | 

CONT | NUE 


ELSEIF (LAST.EQ.FSTSTR) THEN 
NEXT(FSTSTR) = LSTSTR 
PRED(LSTSTR) = FSTSTR 

ENDIF 


IF(SEG.EQ. 1) START - LOLD 
LOLD - LSTSTR 


RETURN 
END 
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SUBROUTINE ORDER(SEG, LINE, HDINDX, HEAD, NEXT, Al, A2, B1, B2, 
+ D2, FSTSTR, LSTSTR, X, Y, START, LENGTH, FIRST, 
+ LOLD, NSEGS, PRED) 


ο, ;;, ;,, τ -.:.--:.----ἕ----------------------.;.;α 


GIVEN THAT A SEGMENT OF THE PATH CROSSES ONE OR MORE BETAS, THIS 
SUBROUT I NE DETERMINES THE ACTUAL ORDER OF CROSSING WHEN TRAVERS ING 
THE SEGMENT FROM BEGINNING TO END. THIS IS DONE BY FIRST DETERMINING 
THE DISTANCE FROM THE SEGMENT START POINT TO THE POINT OF 
INTERSECTION OF EACH CROSSED OBSTACLE REFERENCE LINE. THESE 
DISTANCES ARE THEN SORTED FROM SMALLEST TO LARGEST AND CROSS INGS 

ARE UPDATED IN THE LINK LIST ACCORDINGLY. 


INPUT: HEAD() AND ALL COORDINATES REQUIRED TO DETERMINE THE 
DISTANCES FROM INITIAL VERTEX OF PATH SEGMENT TO EACH OF 
THE CROSSED REFERENCE LINES 


OUTPUT: HEAD(), NEXT() AND PRED() ARRAYS CONTAINING THE RAW STRING 
WHICH ACCURATELY REPRESENTS THE PATH ALONG THE CURRENT 
SEGMENT 


INTEGER SEG, LINE, HEAD(1000), NEXT( 1000), FSTSTR, HDINDX, 
+ START, FIRST( 1000), PRED( 1000), F 

REAL*8 XINTER( 1000), YINTER( 1000), A1(1000), B1( 1000), 
+ A2( 1000), B2( 1000), 02(1000), DIST( 1000), X( 1000), Y( 1000) 


DO 8 J = FSTSTR, LSTSTR 
LINE = ABS(HEAD(J)) 
CALL CASES2 (A1, B1, A2, B2, D2, SEG, LINE, XINTER, YINTER) 
DIST(J) = (XINTER(LINE)-X(SEG) )**2+(YINTER(LINE )-Y (SEG) )**2 


DIST(J) = -DIST(J) 
NEXT(J) = J+1 
PRED(J+1) = J 
8 CONTINUE 
NEXT(LSTSTR) = 0 
PRED(LSTSTR*1) = LSTSTR 


CALL MERG2(DIST, NEXT, PRED, FSTSTR, F) 


NEXT(LOLD) = F 
PRED(F) = LOLD 
IF(SEG.EQ. 1) START - LOLD 
LOLD = NEXT(LOLD) 
17 IF(NEXT(LOLD).NE.O) THEN 
LOLD = NEXT(LOLD) 
GO TO 17 
ENDIF 


RETURN 
END 
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SUBROUTINE CASES2(A1, B1, A2, B2, D2, SEG, LINE, XINTER, YINTER) 
ЖЖЖ ЖЖ ЖЖ ЖЖ ЖЖЖ ЖЖ ЭЖ ЖАЖА ЖЖ Ж Ж ЖЖЖ ЖА ЖЖЖ 


DETERMINES COORDINATES FOR THE POINT OF INTERSECTION OF THE PATH 
SEGMENT AND EACH OF THE REFERENCE LINES IT CROSSES. AGAIN, IN ORDER 
TO MAINTAIN NUMERICAL STABILITY, CALCULATIONS ARE MADE USING THE 
MOST APPROPRIATE CLOSED FORM EQUATION. 


INPUT: COEFFICIENTS OF LINEAR EQUATIONS FOR CURRENT PATH SEGMENT 
AND ALL OBSTACLE REFERENCE LINES WHICH IT CROSSES 


OUTPUT: COORDINATES FOR POINTS OF INTERSECTION OF EACH OBSTACLE 
REFERENCE LINE WITH THE PATH SEGMENT 


IMPLICIT REAL*8 (A-H, O-Z) 


INTEGER SEG 
DIMENSION A1(1000), B1(1000), A2(1000), B2(1000), D2(1000), 
+ XINTER(1000), YINTER(1000), A(2,2) 
A(1,1) = A1(LINE) 
A(1,2) = B1(LINE) 
A(2,1) = A2(SEG) 
A(2,2) = B2(SEG) 
BIGEST = 0.0 
Bo 115 1-2 
DO 1 K = 1,2 
TEST = DABS(A(K,L)) 
IF (TEST.GT.BIGEST) THEN 
BIGEST = TEST 
KBIG = K 
LBIG = L 
ENDI F 
1 CONTINUE 


IF (KBIG.EQ.1) THEN 

IF (LBIG.EQ.1) THEN 
YINTER(LINE)- -D2(SEG)/(B2(SEG)-B1(L INE)*A2(SEG)/A1(L INE)) 
XINTER(LINE)= -B1(LINE)*YINTER(LINE)/A1(LINE) 
RETURN 

ELSE 
XINTER(LINE)= -D2(SEG)/(A2(SEG)-A1(LINE)*B2(SEG)/B1(LINE)) 
YINTER(LINE)= -A1(LINE)*XINTER(LINE)/B1(LINE) 
RETURN 

ENDIF 

ELSE 

IF (LBIG.EQ.1) THEN 

YINTER(LINE) = (D2(SEG)*A1(LINE)/A2(SEG) )/ 
+ (B1(LINE)-B2(SEG)*A1(LINE)/A2(SEG)) 
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XINTER(LINE) = (-D2(SEG)-B2(SEG)*YINTER(LINE) )/A2(SEG) 


RETURN 

ELSE 
XINTER(LINE) - (D2(SEG)*B1(LINE)/B2(SEG) )/ 

t (A1(LINE)-A2(SEG)*B1(L INE) /B2(SEG)) 

YINTER(LINE) = (-D2(SEG)-XINTER(LINE)*A2(SEG) )/B2(SEG) 
RETURN 

ENDIF 

ENDIF 
END 


SUBROUTINE MERG2 (DIST, NEXT, PRED, FSTSTR, F) 
жж а ААСО ОЖ О оО oj ke o X e e oe oe o ood ae ole je ke ak c oko e aeo IC A RC OK A AR ARR RC RC AR OR SR a K 


THIS SUBROUTINE SORTS A SUBSTRING OF ALL POSTIVE INTEGERS INTO 
INCREASING ORDER. 


INPUT: A DOUBLE LINK LIST CONSISTING OF DIST, NEXT, AND PRED ARRAYS 


OUTPUT: A DOUBLE LINK LIST WITH ALL ENTRIES PLACED IN THE ORDER 
IN WHICH THEIR RESPECTIVE REFERENCE LINES WERE CROSSED 


IMPLICIT INTEGER(A-Z) 

REAL*8 DIST( 1000) 

LOGICAL DONE 

DIMENSION NEXT( 1000), PRED( 1000) 


DONE = .FALSE. 
P = FSTSTR 


1 F =P 
CALL SORT2 (F, PREDF, P, DIST, NEXT, DONE, PRED) 
IF(DONE) RETURN 
GOTO 1 


END 
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SUBROUTINE SORT2(F, PREDF, P, DIST, NEXT, DONE, PRED) 


ν....----:..---:--.--΄--.------------------------------ᾱ-ζ; 


ооо 000 


ОО 


MARCHES DOWN A SUBSTRING OF POSITIVE INTEGERS AND ONLY SORTS IF 
ELEMENTS ARE NOT IN INCREASING ORDER. IF A NUMBER NEEDS TO BE 
PLACED HIGHER IN THE LIST SUBROUTINE ‘PUT' IS CALLED TO DO SO 


INPUT: POINTER F INTO DOUBLE LINK LIST ARRAYS DIST, NEXT, AND PRED 


TO INDICATE THE BEGINNING OF A SUBSTING OF POSITIVE INTEGERS, 
AND PREDF 


OUTPUT: P IS A POINTER, DIST(P) IS THE LAST POSITIVE INTEGER IN THE 


SUBSTRING THAT IS BEGUN BY DIST(F) 


IMPLICIT INTEGER (A-Z) 

REAL*8 DIST(1000) 

LOGICAL DONE 

DIMENSION  NEXT(1000), PRED(1000) 
TAIL = F 

NTAIL = NEXT(TAIL) 


IF(NTAIL.EQ.0) THEN 
DONE = .TRUE. 
RETURN 
ENDI F 
IF(DIST(NTAIL).LE.DIST(TAIL)) THEN 
TAIL = NTAIL 
GOTO 1 
ENDIF 
CALL PUT2(F, TAIL, NTAIL, PREDF, DIST, NEXT, PRED) 
GOTO 1 


END 


ΝΗ 


SUBROUTINE PUT2 (F, TAIL, NTAIL, PREDF, DIST, NEXT, PRED) 
CRIA IEEE EE EE KK KK EK EK EK IE EK IE A KE KE KK EK A EA ook oe oe oe ke oe eoe oe oe eoe oe ek 


С REARRANGES POINTERS TO PLACE POSITIVE INTEGERS IN INCREASING ORDER. 


INPUT: F 
TAIL 
NTAIL 


C START OF POSITIVE SUBSTRING 

C END OF CURRENTLY SORTED PORTION OF SUBSTRING 

C NEXT(TAIL) - POINTER TO THE SUCCESSOR OF TAIL IN THE 
C ITEM TO BE INCORPORATED INTO THE SORTED PORTION OF 
C THE LIST 
C 

C 

C 


PREDF THE PREDECESSOR OF F IN LINKED LIST 


OUTPUT: SOME POINTERS IN NEXT AND PRED ARE CHANGED TO PUT DIST(NTAIL) 
IN ITS PROPER PLACE IN THE SORTED PORTION ON THE LIST 


IMPLICIT INTEGER (A-Z) 
REAL*8 DIST(1000) 
DIMENSION МЕХТ( 1000), РҺЕО( 1000) 


IF (DIST(NTAIL).GE.DIST(F)) THEN 
TEMP = NEXT(NTAIL) 
NEXT(NTAIL) = F 
PRED(F) = NTAIL 
NEXT(TAIL) = TEMP 
PRED(TEMP) = TAIL 
F = NTAIL 
RETURN 

ENDIF 

CALL WALK2(F, TAIL, NTAIL, DIST, NEXT, PRED) 

RETURN 

END 
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SUBROUTINE WALK2(F, TAIL, NTAIL, DIST, NEXT, PRED) 
ЖЖЖ ЖЖЖ Ж ЖЖ ЖЖЖ ЕЖ ЖЖ Ж ЖЖ ЖЖ Ж Ж ЖЖЖ ЖЖЖ ЖЖЖ ЖЖ ЖЕЖ ο 


THIS SUBROUTINE WALKS DOWN THE LINKED LIST AND PLACES THE DIST(NTAIL) 
IN THE CORRECT POSITION IN THE DIST ARRAY. 


INPUT: F, TAIL, NTAIL ARE USED AS ABOVE 


OUTPUT: ALTERS POINTERS IN NEXT AND PRED ARRAYS TO PLACE DIST(NTAIL) 
AFTER DIST(F) AND BEFORE DIST(TAIL) IN DOUBLE LINK LIST 


IMPLICIT INTEGER (A-Z) 
REAL*8 DIST( 1000), HNTAIL 
DIMENSION NEXT(1000), PRED( 1000) 


ШЕ E 
МЕХТІ - МЕХТ(1) 
HNTAIL = DIST(NTAIL) 


— 


IF(HNTAIL.GE.DIST(NEXTI)) THEN 
NEXT(I) = NTAIL 
PRED(NTAIL) = | 
NNTAIL = NEXT(NTAIL) 


NEXT(NTAIL) = МЕХТІ 
PRED(NEXTI) = NTAIL 
NEXT(TAIL) = NNTAIL 
PRED(NNTAIL) = TAIL 
RETURN 

ENDIF 

| = ΝΕΧΤΙ 

NEXT! = NEXT(1) 

GOTO 1 


END 
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SUBROUTINE COUNTR(START, NEXT, HEAD, NELEMS) 
C *****tkkkkkkikidkikikikikikikkokikkkokkkkk kk k k kk kk kok kok k okokkkkok kok3kok k kok3kokkkkokkkkkokkok k k 


C THIS SUBROUTINE COUNTS THE NUMBER OF ELEMENTS IN A GIVEN STRING OF 
C CHARACTERS 


C INPUT: HEAD() AND NEXT() ARRAYS FOR THE STRING OF CHARACTERS 
C OUTPUT: NUMBER OF ELEMENTS IN THE STRING 
INTEGER PTR, NEXT(1000), HEAD(1000), START 


PTR - NEXT(START) 
NELEMS - O 


20 IF (PTR.NE.O) THEN 
NELEMS = NELEMS + 1 
PTR = NEXT(PTR) 
СО ТО 20 
ENDIF 


RETURN 
END 
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SUBROUTINE ALG2(NOBS, NELEMS, HEAD, NEXT, X, Y, BX, BY, FR, NR, 
+ PR) 
AAA A KARA HK RRA RA RAK Ж ЖЖЖ ЖА Ж ЖА Ж 


GENERATES THE WELL-KNOW FUNDAMENTAL GROUP REPRESENTATION OF AN 
EQUIVALENCE CLASS. 


INPUT: RAW OR CANONICAL STRING, WITH # OBSTACLES, # ELEMENTS IN 
STRING, COORDINATES OF A AND OBSTACLES (BK) 


OUTPUT: 1) IF INPUT IS RAW STRING, THEN POSSIBLY UNREDUCED 
FUNDAMENTAL GROUP WILL RESULT (IF CANCELLATION OF LIKE 
POSITIVE NUMBERS COULD HAVE OCCURRED IN THE RAW STRING). 
2) ΙΕ INPUT IS CANONICAL STRING, THEN THE RESULTING 
FUNDAMENTAL GROUP WILL BE IN REDUCED FORM. 


REAL*8 XA, YA, XB, YB, X(1000), Y( 1000), Bx( 1000), BY( 1000) 
INTEGER NOBS, NELEMS, HEAD( 1000), NEXT( 1000), PRED( 1000), 
+ FR( 1000), NR( 1000), PR( 1000), S( 1000), FUNDGP( 1000), 
+ START 

LOGICAL RIGHT(1000), RITE 


LENGTH = 1 
START = NEXT(1) 


X(1) 
Y(1) 


DO 1K = 1, NOBS 
XB = BX(K) 
YB = BY(K) 
1 RIGHT(K) = RITE(XA, YA, XB, YB) 


XA 
YA 


NELEM = NELEMS + 1 
DO 10 M = 2, NELEM 
S(M) = HEAD(START) 
J = IABS(S(M)) 
RIGHT(J) = .NOT. RIGHT(J) 
IF(S(M).GT.0) THEN 
LENGTH = LENGTH + 1 
IF(RIGHT(J)) THEN 


FUNDGP(LENGTH) = J 
ELSE 
FUNDGP (LENGTH) = -J 
ENDIF 
ENDIF 


START = NEXT(START) 
IF(START.EQ.0) GOTO 11 
10 CONTINUE 
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11 FR(1) = 0 
NR(1) = 2 
DO 2 | = 2, LENGTH 
FRC 1) = FUNDGP(I) 
NR(I) 2 1 * 1 
PR(I) = I - 1 
2 CONTINUE 


NR(LENGTH) Ξ 0 


RETURN 
END 


LOGICAL FUNCTION RITE(XA, YA, XB, YB) 
Ἂς Ἂς κ ας ας ας Ἂς ας A OK OR A A ЕЖЖЖЖЕЖЖЖЖЖЖЖЖЖЖЕЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖ Ж КЖЖЖЖЖЖЖЖЕЖЖЖЖЖЖЖ Ж 


THIS FUNCTION DETERMINES WHICH SIDE OF A GIVEN DIRECTED LINE ANY 
POINT LIES. 


INPUT: TWO POINTS THAT DETERMINE THE LINE 


OUTPUT: LOGICAL VARIABLE THAT IS TRUE IF A POINT LIES TO THE RIGHT 
AND FALSE IF A POINT LIES TO THE LEFT 


REAL*8 XB, YB, XA, YA, SIGNA 
RITE = .TRUE. 
SIGNA z -((YB*XA) - (XB*YA)) 
IF(SIGNA.LT.O)THEN 
RITE = .FALSE. 
RETURN 
ENDIF 
IF(SIGNA.EQ.0) THEN 
PRINT*,'THE POINT A LIES ON THE LINE LK PROGRAM STOPS" 
STOP 
ENDIF 


RETURN 
END 
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SUBROUTINE CANALG2(HEAD, NEXT, PRED) 
AEA EE EE AE RH KE AE EE AR AR AE AE RE AB A A AR AR A ER A ok oe oe o oe oe ok oe oe o ae e o oe oc opo o o Xe ok op e oo oo 


THIS SUBROUTINE TAKES AN UNREDUCED FUNDAMENTAL GROUP REPRESENTATION 
OF A GIVEN CLASS AND CANCELS A GENERATOR IF IT IS ADJACENT TO ITS 
INVERSE. 


INPUT: HEAD, NEXT, AND PRED ARRAYS 


OUTPUT: HEAD, NEXT, AND PRED ARRAYS WITH NEXT AND PRED REARRANGED 
TO SKIP AROUND CANCELLED ELEMENTS 


IMPLICIT INTEGER (A-Z) 
DIMENSION HEAD( 1000), NEXT( 1000), PRED( 1000) 


START = 1 
PTR1 = START 
PTR2 = START 


PTR3 = NEXT(PTR2) 
10 IF (PTR3.NE.0) THEN 
IF (HEAD(PTR2).EQ.-(HEAD(PTR3))) THEN 
NEXT(PTR1) = NEXT(PTR3) 
PRED(NEXT(PTR3)) - PTR1 
IF(NEXT(PTR1).EQ.0) RETURN 


РТВ2 = РТВ1 
РТВ1 = РВЕО(РТВ1) 
PTR3 = NEXT(PTR2) 
ELSE 
PTR1 = PTR2 
PTR2 = PTR3 
PTR3 = NEXT(PTR2) 
ENDIF 
GO TO 10 
ENDIF 
RETURN 
END 
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SUBROUTINE ALG1(HEAD, NEXT, PRED, NELEMS) 


SR AI aC IIR a aR oR a aR aR I aR oko Жжжж жж Жжжж ж жооок о 


THIS SUBROUTINE TAKES A GIVEN RAW STRING OF CHARACTERS REPRESENTING 
A PATH AND PRODUCES THE CANONICAL FORM OF THAT STRING. THIS IS DONE 
BY FIRST ORDERING ALL OF THE ALPHA SUBSTRINGS FROM SMALLEST TO 
LARGEST IN ABSOLUTE VALUE. NEXT, CANCELLATION IS PERFORMED TO 
ELIMINATE ALL LIKE PAIRS OF ADJACENT ELEMENTS FROM THE STRING. 


INPUT: БАМ STRING IN FORM OF DOUBLE LINKED LIST WITH HEAD(), МЕХТ() 
AND PRED() ARRAYS 


OUTPUT: CANONICAL FORM OF THE RAW STRING 


IMPLICIT INTEGER (A-Z) 
DIMENSION HEAD( 1000), NEXT( 1000), PRED( 1000) 


START = 1 


CALL MERG1(HEAD, NEXT, PRED) 
CALL CANCEL(START, HEAD, NEXT, PRED, NELEMS) 


RETURN 
END 
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SUBROUTINE MERG1 (HEAD, NEXT, PRED) 


С ЖЖЖЖЖжЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖ OK EE EK RK EE OK AE ER EE EE ER EE EE EOE AEE IRE OR OR ER EK EEK OK KK 


C THIS SUBROUTINE DOES THE INITIAL SORT OF THE ALPHA SUBSTRINGS IN THE 
С RAWSTRING (INCREASING IN ABSULUTE VALUE). 


C 


O 


ООООЮО 


INPUT: HEAD, NEXT, PRED ARRAYS REPRESENTING A DOUBLE LINKED LIST 


OF THE RAWSTRING WITH THE ALPHA SUBSTRINGS UNORDERED 


OUTPUT: POINTERS STORED IN THE ARRAYS NEXT AND PRED ARE ALTERED SO 


= 


THAT EACH SUBSTRING OF THE STORED LIST WHICH CONSISTS 
ENTIRELY OF NEGATIVE INTEGERS IS SORTED INTO NON- INCREAS ING 
ORDER, WHILE SUBSTRINGS OF POSITIVE INTEGERS ARE LEFT 
UNALTERED. 

IMPLICIT INTEGER(A-Z) 

LOGICAL DONE 

DIMENSION HEAD( 1000), NEXT( 1000), PRED( 1000) 


DONE = .FALSE. 
P = 1 


CALL FRONT (P, F, PREDF, HEAD, NEXT, DONE) 
IF(DONE) RETURN 

CALL SORT (F, PREDF, P, HEAD, NEXT, DONE, PRED) 
IF(DONE) RETURN 

GOTO 1 


END 
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SUBROUTINE FRONT(P, F, PREDF, HEAD, NEXT, DONE) 
CRRA ER OK EK RK RAK EK RACK RAR ACE EK KK HK IK 


FINDS THE BEGINNING OF NEGATIVE INTEGER STRINGS (ALPHA STRING) 


©) 


INPUT: POINTER P INTO LINKED LIST 


C 
C OUTPUT: F IS A POINTER INTO THE HEAD ARRAY. POINTS TO FIRST NEGATIVE 
С ENTRY WHICH OCCURS STRICTLY AFTER HEAD(P). PREDF IS POINTER 
C SUCH THAT HEAD(PREDF) IS THE PREDESSOR OF HEAD(F). 

IMPLICIT INTEGER(A-Z) 

LOGICAL DONE 

DIMENSION HEAD( 1000), NEXT( 1000) 


F = P 
1 PREDF = F 

F = NEXT(F) 

IF (F.EQ.0) THEN 
DONE = .TRUE. 
RETURN 

ENDIF 


IF (HEAD(F).LT.0) RETURN 
GOTO 1 


END 
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SUBROUTINE SORT(F, PREDF, P, HEAD, NEXT, DONE, PRED) 


С ЖЖЖ ЖЖЖ ЖЖ ЖЖЖ ЖЖ ЖЖЖ ККЖ ЖЖЖ ЖЖ ЖКЖ Ж ЖЖЖ Ж ЖЖЖ ЖЖЖ Ж ЖЕЖ ЖЖЖ ЖЖЖ HK KKH HK KH HK HK 


OOO Οσο 
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MARCHES DONN A SUBSTRING OF NEGATIVE INTEGERS AND ONLY SORTS IF 
ELEMENTS ARE IN INCREASING ORDER. IF A NUMBER NEEDS TO BE 
PLACED HIGHER IN THE LIST SUBROUTINE ‘PUT’ IS CALLED TO DO SO 


INPUT: POINTER F INTO DOUBLE LINK LIST ARRAYS HEAD, NEXT, AND PRED 


TO INDICATE THE BEGINNING OF A SUBSTRING OF NEGATIVE 
INTEGERS; AND PREDF 


OUTPUT: P IS A POINTER, HEAD(P) IS THE LAST NEGATIVE INTEGER IN THE 


SUBSTRING THAT IS BEGUN BY HEAD(F) 


IMPLICIT INTEGER (A-Z) 
LOGICAL DONE 
DIMENSION HEAD( 1000), NEXT( 1000), PRED( 1000) 


TAIL = F 
NTAIL = NEXT(TAIL) 


IF(NTAIL.EQ.O) THEN 
DONE - .TRUE. 
RETURN 

ENDIF 


IF(HEAD(NTAIL).GT.O) THEN 
P = TAIL 
RETURN 
ENDIF 
IF(HEAD(NTAIL).LE.HEAD(TAIL)) THEN 
πὶ 
GOTO 1 
ENDIF 
CALL PUT(F, TAIL, NTAIL, PREDF, HEAD, NEXT, PRED) 
GOTO 1 


END 
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SUBROUTINE PUT (F, TAIL, NTAIL, PREDF, HEAD, NEXT, PRED) 
С ЖЖЖ Ж ЖЕ ЖЖ ЖЕ КЖ ЕЕ ӘЖЕ Ж ЖЕ ЖА ЖЖ ЕЕ ЕЕ ЕЕЕ АЖ Ж ЖЖ Ж ЕЕЕ ЖЕЖ ЖЕ ЖЕЖ ЖЕЖ ЕЖ ЖЕЖ Ж 


С SUBROUTINE THAT REARRANGES POINTERS TO PLACE A NEGATIVE INTEGER IN 
С NON-INCREASING ORDER. 


INPUT: F - START OF NEGATIVE SUBSTRING 
TAIL - END OF CURRENTLY SORTED PORTION OF SUBSTRING 
NTAIL = NEXT(TAIL) - POINTER TO THE SUCCESSOR OF TAIL IN THE 


ITEM TO BE INCORPORATED INTO THE SORTED PORTION OF 
THE LISIT: 
PREDF - THE PREDECESSOR OF F IN LINKED LIST 


C 
C 
C 
C 
C 
C 
C OUTPUT: SOME POINTERS IN NEXT AND PRED ARE CHANGED TO PUT HEAD(NTAIL) 
C IN ITS PROPER PLACE IN THE SORTED PORTION ON THE LIST 

IMPLICIT INTEGER (A-2) 

DIMENSION HEAD( 1000), NEXT(1000), PRED( 1000) 


IF (HEAD(NTAIL).GE.HEAD(F)) THEN 
NEXT(PREDF) = NTAIL 
PRED(NTAIL) = PREDF 
TEMP = NEXT(NTAIL) 
NEXT(NTAIL) = F 
PRED(F) = NTAIL 
NEXT(TAIL) = TEMP 
PRED(TEMP) = TAIL 


F = NTAIL 
RETURN 
ENDIF 


CALL WALK(F, TAIL, NTAIL, HEAD, NEXT, PRED) 


RETURN 
END 
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SUBROUTINE WALK(F, TAIL, NTAIL, HEAD, NEXT, PRED) 
* * * < 1: K 3 3 3 3 A OR KOR KOR KOR K K KOR R K ƏK ƏÉR K K K [K oke oo oe okc ke ke oe ok oc ke oe oe okc oe oco kc ook ook 2k oc kc oe ok okc ook oco ak ac a 


THIS SUBROUITNE WALKS DOWN THE LINKED LIST AND PLACES THE HEAD(NTAIL) 
IN THE CORRECT POSITION IN THE HEAD ARRAY. (DECREASING ORDER) 


INPUT: F, TAIL, NTAIL ARE USED AS ABOVE 


OUTPUT: ALTERS POINTERS IN NEXT AND PRED ARRAYS TO PLACE HEAD(NTAIL) 
AFTER HEAD(F) AND BEFORE HEAD(TAIL) ІМ DOUBLE LINK LIST 


IMPLICIT INTEGER (A-Z) 
DIMENSION HEAD(1000), NEXT( 1000), PRED( 1000) 


ΞΕ 
МЕХТІ - МЕХТ(1) 
HNTAIL = HEAD(NTAIL) 


1 IF(HNTAIL.GE.HEAD(NEXTI)) THEN 
NEXT(1) = NTAIL 
PRED(NTAIL) = } 

NNTAIL = NEXT(NTAIL) 
NEXT(NTAIL) = NEXT 
PRED(NEXT!) = NTAIL 
NEXT(TAIL) = NNTAIL 
PRED(NNTAIL) = TAIL 
RETURN | 

ENDIF 


| = МЕХТІ 
МЕХТІ - МЕХТ(1) 
GOTO 1 


END 
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SUBROUTINE CANCEL(START, HEAD, NEXT, PRED, NELEMS) 


HEE AEE HEHE HH HE HE HE EK HE A A AK AE EK EE RK AE EK EK AK EK HEAR HK HK HK HK ARH RK KK HK KR KK KKK KK HK HEH 


GIVEN THE SORTED RAW STRING, THIS SUBROUTINE REDUCES THE STRING TO 
CANONICAL FORM BY ADJUSTING THE LINK LIST TO SKIP ANY PAIRS OF 
ADJACENT LIKE ELEMENTS IN THE STRING. ONCE TWO ELEMENTS ARE 
ELIMINATED FROM THE STRING, THE SUBSTRINGS WHICH WERE ON THEIR LEFT 
AND RIGHT CONCATENATE TO FORM A NEW STRING AND HENCE A NEW PAIR OF 
ADJACENT ELEMENTS WHICH MUST ALSO BE CHECKED FOR EQUALITY. IN THE 
EVENT A BETA SUBSTRING BECOMES ANNHILATED FROM THE STRING, THE TWO 
ADJACENT ALPHA STRINGS CONCATENATE AND ARE AGAIN SORTED FROM SMALLEST 
TO LARGEST IN ABSOLUTE VALUE AS A SINGLE SUBSTRING. 


INPUT: SORTED RAW STRING 
OUTPUT: CANONICAL FORM OF THE RAW STRING 


IMPLICIT INTEGER (A-Z) 
DIMENSION HEAD( 1000), NEXT( 1000), PRED( 1000) 


START = 1 
START1 = START 
START2 = START 
BETA = START 
PIR START 1 
PTR2 START 1 

50 PTR3 - NEXT(PTR2) 


IF (HEAD(PTR3).LT.O) THEN 
START 1 PTR3 
START2 = START1 

ELSE 
BETA = PTR3 

ENDIF 


10 IF (PTR3.NE.0) THEN 
CALL CHEKER (HEAD, START1, START2, PTR1, PTR2, PTR3, BETA) 
IF (HEAD(PTR2).EQ.HEAD(PTR3)) THEN 
NEXT(PTR1) - NEXT(PTR3) 
PRED(NEXT(PTR3)) = PTR1 
PTR2 = NEXT(PTR3) 
IF (PTR2.EQ.0) GO TO 60 
CHECK1 - HEAD(PTR2) * HEAD(PTR3) 
CHECK2 - HEAD(PTR1) * HEAD(PTR2) 
IF (CHECK1.LT.O.AND. CHECK2.GT.O. AND. HEAD(PTR2) . LT. O) THEN 
PTR2 = PTR1 
PTR1 PRED(PTR1) 
PTR3 = NEXT(PTR2) 
5ТАКТ1 - START2 
6 IF (START1.NE.1.AND.HEAD(PRED(START1)).LT.0O)THEN 
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START1 = PRED(START1) 
GO TO 6 
ENDIF 
START2 = PTR3 
CALL MERGE (HEAD, NEXT, START1, START2, PRED) 
PTR1 = PRED(START1) 
РТЕ2 = РТВ1 
GO TO 50 


ELSEIF (CHECK1.LT.0.AND.CHECK2.EQ.0.AND.HEAD(PTR2).LT.O) 


THEN 


БЕЗЕ 
ТНЕМ 


PTR2 - РТК1 

PTR3 = NEXT(PTR1) 

START1 = PTR3 

START2 = STARTI 

GO TO 10 

IF (CHECK1.GT.0.AND.CHECK2.GT.0.AND.HEAD(PTR2).GT.0) 


IF (BETA.EQ.2) THEN 
BETA = 1 
ELSEIF (BETA.EQ.1) THEN 
G TO 9 
ELSE 
IF(START1.NE.1) BETA = PRED(START1) 
IF(HEAD(PRED(BETA)).GT.O) THEN 
BETA - PRED(BETA) 
GO TO 11 
ENDIF 
ENDIF 
PTR1 PRED(BETA) 
PTR2 - BETA 
PTR3 - NEXT(PTR2) 
GO TO 10 


ELSEIF (CHECK1.LT.O.AND.CHECK2.GT.O.AND.HEAD(PTR2) .GT.0O) 


THEN 


PTR2 
PTR] 


PTR1 
PRED(PTR1) 


IF(HEAD(PTR1).LT.O)THEN 
START! - РТК1 | 
IF (HEAD(PRED(START1)) .LT.O)THEN 
START1 = PRED(START1) 
GO TO 5 
ENDIF 
ENDIF 
PTR3 = NEXT(PTR2) 
GO TO 10 


ELSEIF (CHECK1.LT.O.AND.CHECK2.LT.0.AND.HEAD(PTR2).LT.0) 
THEN 


IF(START1.EQ.1) THEN 
START1 = PTR2 
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PTR2 


START2 = 
= NEXT(PTR2) 


PTR3 

ELSE 
START1 = START2 
PTR3 = NEXT(PTR2) 

ENDIF 

GO TO 10 

PESE 
START1 = START2 
PTR3 = NEXT(PTR2) 


ENDIF 
EESE 

PTR1 = PTR2 

PTR2 = PTR3 

PTR3 = NEXT(PTR2) 
ENDIF 
GO TO 10 


ENDIF 
60 CALL COUNTR (START, NEXT, HEAD, NELEMS) 


RETURN 
END 
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SUBROUTINE CHEKER(HEAD, START1, START2, PTR1, PTR2, PTR3, BETA) 


XR U£ K KOK ЖЕЖ ag ac a ac okc oe c ac kc oic kc oc oc oe oc oc ac oe kc oko akc a oc opc ЖЖК IC a I aC ЕЖ ЖЕ ЖЖЖ ЕЖ aC ж. Ж + 


AS POINTERS MOVE ALONG THE CHARACTER STRING DURING CANCELLATION THIS 
SUBROUTINE CHECKS TO DETERMINE WHETHER OR NOT THE END OF ONE 
SUBSTRING 15 REACHED AND A NEW ONE BEGINS. DEPENDING ON THE OUTCOME 
OF THIS CHECK, THE POINTERS USED TO IDENTIFY THE BEGINNING OF THE 
TWO LATEST ALPHA STRINGS AND THE LATEST BETA STRING ARE UPDATED 


INPUT: HEAD() ARRAY AND PRESENT POINTER LOCATIONS FROM 'CANCEL' 
SUBROUT | NE 


OUTPUT: MODIFIED INDICES FOR LOCATION OF ALPHA AND BETA STRINGS 
INTEGER HEAD( 1000), START1, START2, PTR1, PTR2, PTR3, CHECK, BETA 
CHECK = HEAD(PTR3) * HEAD(PTR2) 


IF (CHECK .GT.0) THEN 
IF (HEAD(PTR2).LT.O.AND.HEAD(PTR1).GT.0) START2 
IF (HEAD(PTR2).GT.O.AND.HEAD(PTR1).LT.0) BETA = 
ELSEIF (CHECK.LE.0) THEN 
IF (HEAD(PTR2).GT.O.AND.HEAD(PTR1).LT.O) THEN 
BETA - PTR2 
START1 = START2 
START2 = PTR3 
ELSEIF (HEAD(PTR2).GT.0) THEN 
IF (START1.NE.1) THEN 


= PTR2 
PTR2 


START1 = START2 
START2 = PTR3 
ELSE 
START1 = PTR3 
START2 = START1 
ENDIF 
ELSEIF (HEAD(PTR2).LT.0.AND.HEAD(PTR1).GT.0) THEN 
BETA = PTR3 


START1 = START2 
START2°= PTR2 
ELSEIF (HEAD(PTR2).LT.O.AND.HEAD(PTR1).LT.0) THEN 
BETA = PTR3 
ENDIF 
ENDIF 


RETURN 
END 
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SUBROUTINE MERGE (HEAD, NEXT, START1, START2, PRED) 
ЖЖЖ ЖЖЖ ЖЖЖ ЖӘНЕ ЖЖ ЖЖЖ KKK AK EAA AK ERA ЖЖЖ ЖЖЖ 


THIS SUBROUTINE MERGES TWO ORDERED ALPHA STRINGS. THE RESULTING 
SUBSTRING WILL BE INCREASING IN ABSOLUTE VALUE. 


INPUT: HEAD(), NEXT() AND PRED() ARRAYS ALONG WITH INDICES START1 
AND START2 INDICATING BEGINNING OF THE ALPHA STRINGS TO BE 
MERGED 


OUTPUT: MODIFIED STRING CONTAINING THE MERGED ALPHA STRINGS WHICH 
WERE A RESULT OF ANNHILATION OF A BETA STRING 


INTEGER HEAD( 1000), NEXT( 1000), START1, START2, P1, P2, TAIL, 
+ PRED( 1000) 
LOGICAL GO 


IF (START1.EQ.1) GO TO 2 
IF(HEAD(PRED(START1)).EQ.O) START1 - NEXT(PRED(START1)) 


IF (NEXT(PRED(START1)).NE.START1)THEN 
START1 = NEXT(PRED(START1)) 
7 IF (START1.EQ.1) GO TO 2 
IF(HEAD(START1).GT.0)THEN 
START1 = NEXT(START1) 
GO TO 7 
ENDIF 
8 IF(HEAD(PRED(START1)).LT.0)THEN 
START1 = PRED(START1) 
GO TO 8 
ENDIF 
ENDI F 


2 CALL SET(HEAD, NEXT, START1, START2, P1, P2, TAIL, PRED) 
1 IF(GO(P1, P2, START2, HEAD, NEXT)) THEN 
CALL MERGER(HEAD, NEXT, P1, P2, TAIL, PRED) 
GOTO 1 
ENDIF 


CALL FXTAIL(HEAD, NEXT, P1, P2, TAIL, START2, PRED) 


RETURN 
END 
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о о © 


SUBROUTINE SET(HEAD, NEXT, START1, START2, P1, P2, TAIL, PRED) 
xke oec oe ke oko oe eoe ok oe kc okc oe ke ok oe kc oe ke eoe ok oe oe oe ok oc oe oe ke ke oe oe oe ke ЖЕ ЖЖЖ ЖЕ ЖЖЖЖЖЖЕЖЖЖ ЖЕ ЖЖЕЖЖЕЖЖЖЖЖ 


SETS THE STARTING POINTER OF THE NEW STRING AND THE TWO POINTERS 
OF THE STRINGS TO BE MERGED 


INPUT: POINTERS INTO TWO ALPHA STRINGS 
OUTPUT: POINTER INTO BEGINNING OF A NEW SORTED STRING 


INTEGER HEAD( 1000), NEXT(1000), START1, START2, P1, P2,TAIL, 
+ PRED( 1000) 


P1 = START1 
P2 = START2 
IF (HEAD(P1).GT.HEAD(P2)) THEN 
TAIL = P1 
START1 = P1 
P1 - NEXT(P1) 
ELSE 
TAIL = P2 
START1 = P2 
NEXT(PRED(P1)) = P2 
PRED(P2) = PRED(P1) 
P2 = NEXT(P2) 
ENDIF 


RETURN 
END 
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LOGICAL FUNCTION GO(P1, P2, START2, HEAD, NEXT) 
С ЖЖЖ ЖЖК ЖЖ ЖЕ ЖЕ ЖЕ ЖЕ Ж ЖЕ ЖЕЖ ЖЖ ЖЖЖ ЖЖЖ ЕЖ K £ 2 I A OE I 2 I E E E E E A E I a I 2 a A 


C LOGICAL FUNCTION TO DETERMINE WHEN THE END OF EITHER LIST IS REACHED 
INPUT: POINTERS INTO TWO ALPHA SUBSTRINGS 


C 
C OUTPUT: LOGICAL VARIABLE WHICH IS TRUE IF EITHER POINTER IS AT THE 
C END OF A STRING, AND FALSE OTHERWISE 


INTEGER HEAD( 1000), NEXT(1000), P1, P2, START2 
GO = .TRUE. 


IF(P1.EQ.START2)THEN 
GO - .FALSE. 
RETURN 

ENDIF 


IF (NEXT(P2).EQ.0)THEN 
GO = .FALSE. 
RETURN 

ENDIF 


IF(HEAD(P2) .GT.O)THEN 
GO - .FALSE. 
RETURN 

ENDIF 


RETURN 
END 
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SUBROUTINE MERGER(HEAD, NEXT, P1, P2, TAIL, PRED) 


С eee eoe koe eoe ok eoe e oe oe ЖЕ ЕЕ ЖЕЖ ЖЕ ЖЖЖ ЖЕЖ ЕСЖ ЖЕ ЖЖЕЖЖЕЖЖЖЖЖЖЖЖЖЖЖ ЖЖЖ Ж 


ООО 


THIS SUBROUTINE COMPARES TWO ELEMENTS - ONE IN EACH ALPHA SUBSTRING 
AND PLACES THE ONE THAT IS THE SMALLEST ON THE LIST REPRESENTING THE 
NEW SORTED LIST 


INPUT: HEAD, NEXT, PRED, AND POINTERS INTO THE HEAD ARRAY 


OUTPUT: HEAD, NEXT, PRED, AND POINTERS FOR THE NEXT TWO ELEMENTS 


TO BE CHECKED 
INTEGER HEAD( 1000), NEXT(1000), P1, P2, TAIL , PRED(1000) 


IF(HEAD(P1).GT.HEAD(P2)) THEN 

CALL TACON1(NEXT, P1, TAIL, PRED) 
ELSE 

CALL TACON2(NEXT, P2, TAIL, PRED) 
ENDIF 


RETURN 
END 


SUBROUTINE TACON1 (NEXT, P1, TAIL, PRED) 


Q exeo eoe coke seo oe oe oc oe oe ok ke ας coe kc oe oe oe kc oe oe ke ke oe ke kc oe coke oe oe Ж ЖЖ hcc coe oe kc oe eoe o o oe oe e e doe xc EE 


C 


C 


ADDS THE ELEMENT TO WHICH P1 POINTS TO THE TAIL OF THE NEW STRING 
INPUT: NEXT, PRED, P1, TAIL 


OUTPUT: NEXT, PRED, P1, TAIL 


INTEGER NEXT( 1000), P1, TAIL, PRED( 1000) 


NEXT(TAIL) = P1 
PRED(P1) = TAIL 
TAIL = P1 

P1 = NEXT(P1) 


RETURN 
END 
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SUBROUTINE TACON2 (NEXT, P2, TAIL, PRED) 
С Жж ЖЖ ЕКЕ ЖЕЖ ЕЕ ЖЕЖ Ж Ж ЖЕЖ ЖЕ Ж Ж ЖЖЖ ЖЖЖ ЖЕЖ Ж ЖЕЖ ЖЖ ЖЖ ЖЖЖ ЖЖ ЖЖ Ж 


ADDS THE ELEMENT TO WHICH P2 POINTS TO THE TAIL OF THE NEW STRING 


О 


С INPUT: NEXT, PRED, P2, TAIL 


OUTPUT: NEXT, PRED, P2, TAIL 


O 


INTEGER NEXT(1000), P2, TAIL, PRED(1000) 


NEXT(TAIL) 
PRED(P2) - 
TAIL - P2 
P2 = NEXT(P2) 
RETURN 

END 


= P2 
TAIL 
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SUBROUTINE FXTAIL(HEAD, NEXT, P1, P2, TAIL, START2, PRED) 
Ἄς ICE A HE A A AK EA HE A HE AE A A AE ER HK HK EE AE EE ER EI AR EK EK AEA ER EE A RE EK OE OK eoe R 


ATTACHES THE END OF THE LONGER SORTED STRING TO THE END OF THE MERGED 
STRING 


INPUT: P1, P2, HEAD, NEXT, PRED, TAIL 
OUTPUT: P1, P2, HEAD, NEXT, PRED, TAIL, START2 


INTEGER HEAD( 1000), NEXT( 1000), P1, P2, TAIL, START2, P11, 
+ PRED( 1000) 


IF(P1.EQ.START2)THEN 
CALL TACON2(NEXT, P2, TAIL, PRED) 
RETURN 

ENDIF 


IF(NEXT(P2).EQ.O)THEN 
CALL TACONI(NEXT, P1, TAIL, PRED) 
P11 = TAIL 
2 IF(P1.NE.START2)THEN 
P11 = P1 
P1 = NEXT(P1) 
GOTO 2 
ENDIF 
NEXT(P11) = P2 
PRED(P2) = P11 
RETURN 
ENDIF 


ΙΕ(ΗΕΑΟ(Ρ2) .ατ.Ο)ΤΗΕΝ 
CALL TACONI(NEXT, P1, TAIL, PRED) 
P11 = TAIL 
3 IF(P1.NE.START2) THEN 
P11 = P1 
= NEXT(P1) 
GOTO 3 
ENDIF 
NEXT(P11) = P2 
PRED(P2) = P11 
RETURN 
ENDIF 


RETURN 
END 
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SUBROUTINE CTREX(FL, NL, PL, FR, NR, PR, BSEED, PSEED) 
ECC xo IS OR AR AG ORR AR IE IE ACO o AR AR aR a A IR Roo ap oe oe orc oc ok oko o akcokc oro oe ooo oc opo coke oc orco oc ook XR oc opo op oR aoo COE 


THIS SUBROUTINE CHECKS F(C(R(P))) AGAINST K(F(R(P))) FOR EQUALITY. 
INPUT: FUNDAMENTAL GROUP REPRESENTATIONS FOR BOTH ALGORITHMS 


OUTPUT: MESSAGE INDICATING THE OCCURRENCE OF UNEQUAL FUNDAMENTAL 
GROUPS 


INTEGER FL( 1000), NL( 1000), PL( 1000), FR( 1000), NR( 1000), PR( 1000) 
IF(NL(1).EQ.0.AND.NR(1).EQ.0) GO TO 11 


| 
J 


NL(1) 
NR( 1) 


10 IF (I.EQ.O.AND.J.EQ.0) GO TO 11 
IF (FL(I).EQ.O.AND.FR(J).EQ.0) GO TO 11 


IF (FL(I).EQ.FR(J)) THEN 

I = NL(I) 

J = NR(J) 

GOTO 10 

ELSE 

PRINT#, ‘STRINGS UNEQUAL ' 

PRINT*,' ' 

IF(NL(1).EQ.O)THEN 
PRINT*,'THE GROUP |S EMPTY AFTER ALG1 SEQUENCE' 

ELSE 
PRINT*,'THE FUNDAMENTAL GROUP AFTER ALG1 IS:' 
CALL PRINTS(FL,NL) 

ENDIF 

IF(NR(1).EQ.0) THEN 
PRINT*, ‘THE GROUP IS EMPTY AFTER ALG2 SEQUENCE’ 

ELSE 
PRINT*, 'THE FUNDAMENTAL GROUP AFTER ALG2 15: ' 
CALL PRINTS(FR,NR) 

END | F 

PRINT*,' ' 

PRINT*,'BSEED AND PSEED ARE',BSEED,PSEED 


ENDIF 


11 RETURN 
END 
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ОО 


SUBROUTINE PRINTS(HEAD, NEXT) 
ЖАЖА ЖЖ ЕХ ХЖЖ ЖА ЖЖЖ ЖЖЖ e ok oe oe orco rok orco ap oco ae de oc Acc coo x ok X ok ook o XC AR OK aR OKI ay oR 


THIS SUBROUTINE CAN BE USED TO PRINT OUT ANY STRING THAT IS STORED IN 
LINK LIST FORM 


INPUT: LINK LIST ARRAYS 
OUTPUT: HORIZONTAL STRING OF THE ELEMENTS ACCORDING TO THE NEXT() 
INTEGER HEAD(1000), NEXT(1000), STRING(1000) 


NSTART - МЕХТ(1) 
| = O 


98 IF(NSTART.NE.0) THEN 
|z | + 1 
STRING(I) = HEAD(NSTART) 
NSTART = NEXT(NSTART) 
GOTO 98 
ENDIF 


PRINT 111, (STRING(J), J = 1, 1) 
111 FORMAT(' ',2014) 
PRINT*,' ' 


RETURN 
END 
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ALL SUBROUTINES BELOW THIS POINT WERE USED AS DEBUG TOOLS. THEY 
GENERATE CRUDE GRAPHS WHICH PLOT THE BOARDS AND THE PATHS. 
THE VALUES AQUIRED BY THE RAWSTRING , MERGE, AND MANY OTHER 


SUBROUTINES WERE CHECKED USING THESE ROUTINES. 
ЖАС ЖЖЖ ЖЖК Ж ЕХ Ж ЖЕСЕ ЖЖЖ ЖЕК ЖЖЖ IS AR IC AK a So decode doe 


O O O O O 


SUBROUTINE GRAPH(BX, BY, X, Y, NOBS, NUMPTS) 
Locke ext coe ace sce e A age e a aae a Ἄς Ἄς ke o Ἡς eg op sco tee te ee c ced ce t eoe oe coe e coke oe kc coke ze e oe odo oce 


REAL*8 X(1000), Y(1000), BX(1000), BY(1000) 
CHARACTER*1 MATR(53, 105) 


CALL GRAFPA(X, Y, NUMPTS, MATR) 
CALL GRAFOB(BX, BY, NOBS, MATR) 


DO 1 I = 1,53 
1 PRINT 111, (MATR(1I,J), J=1,105) 
111 FORMAT(' ',105A1) 


RETURN 
END 
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SUBROUTINE GRAFPA (X, Y, NUMPTS, MATR) 
С RAR AR ARR RA ER ok ok ook ok ok oe o OE OO OR oe o o ok oe op ok oe o o oe o o oc ok ok oe o oo ook ooo Eo oc op ok oc o AR AE OR RE OR oko oc ooo o oc 


REAL*8 X(1000), Y(1000) 
CHARACTER*1 MATR(53, 105), CH 


Do 10 = 2,52 
10 MATR(L,M) = ' ' 


DO 1 | = 1, 105 
MATR(1,1) = '*' 
1 MATR(53,1) = '*' 


SONI SE 
MATR(I,1) = Ж 
4 MATR(1,105) = '*' 


XK = X(1) 

YK = Y(1) 

CALL COOR(XK, YK, IX, IY) 
CALL CHARPA(1, CH) 
MATRCIY,1X) = CH 


DO 2 K = 2,NUMPTS 
2 CALL FILL(K, X, Y, MATR) 


DO 3 K = 2,NUMPTS 
XK = X(K) 
YK = Y(K) 


CALL COOR(XK, YK, IX, ΙΥ) 
CALL CHARPA(K, CH) 
3 MATR(IY,IX) = СН 


RETURN 
END 


SUBROUTINE COOR(BX, BY, IX, IY) 
С kb ook oko oe ok ok oe ok oc ok ook ok oe oe oe ok ok oe oe ok oe oe oc oe ok oe oc oe oe oe ooo oe oe oe oc eoe ok oe oe oe oe oe ok oe oe ok oe oe ok oe oe oe oe oe eoe 


REAL*8 BX, BY 


IX = MESHP(BX) * 2 
lY - 54 - МЕ5НР(ВҮ) 
RETURN 

END 
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INTEGER FUNCTION MESHP(X) 
C ekileokokek oco oe ok oko ok k kk kk kkk sic ok oec oe kc okeokc oe oc koc oe ok oj oc kc oc xkc ok oj oj oic oe ok okeok k kakak kk kkk k kkk k kkk kkk 


REAL*8 X 
MESHP z ((X*1.)*(51./2.)) + 2. 


RETURN 
END 


SUBROUTINE CHARPA(K, CH) 
С ЖЕЗ OR AIC ARC FR Ok A AC OC a do ae eoe eee sc e Ж ЖАС ЖЖС КЖ aR eoe o oe ood eoe d ote Re oe oc ec oe c eoe oo Ж 


CHARACTER*1 CH 


IF(K.EQ.1) THEN 
CH = 'A' 
RETURN 

END IF 


IF(K.EQ.2) THEN 
CH = 'B' 
RETURN 

END IF 


IF(K.EQ.3) THEN 
πο 
RETURN 

ENDIF 


IF(K.EQ.4) THEN 
τω - Ὁ 
RETURN 

ENDIF 


IF(K.EQ.5) THEN 
СНс Е 
RETURN 

ENDI F 


IF(K.EQ.6) THEN 
CH = 'A' 
RETURN 

ENDI F 


END 
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SUBROUTINE FILL(K, X, Y, MATR) 
С ЖЖЖ ЖЖ ЖЖЖ ЖЖ ЖЖЖ ЖЖЖ ЖЖЖ ЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖжЖжжжжжЖжжжж 


REAL*8 X(1000), Y(1000), U, V, DX, DY, XK, YK, XKM1, YKM1 
CHARACTER*1 MATR(53,105) 


XK 
YK 
XKM1 = X(K-1) 
YKM1 = Y(K-1) 


I HI 
=< 
= 
A^ 
Ww 


CALL COOR(XK, YK, KX, KY) 
CALL COOR(XKM1, YKM1, KXM1, KYM1) 


IABS(KX - KXM1) - 1 
IABS(KY = KYM1) =- 1 
M.GT.L) L = M 
XK - XKM1)/(L+1) 
ΠΤ 
= 1,L 
U = XKM1 + J*DX 
V = YKMI + J*DY 
CALL COOR(U,V, IU, IV) 
1 MATR(IV, 10) = '+' 


C m ач 


RETURN 
END 


SUBROUTINE GRAFOB (X, Y, NOBS, MATR) 
С ЖЖЖжЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЖЕЖЖЖЖЖЖЖЖ ЖЖЖ eo oe ok oe oko eo oe oe E oo ook eoo oco eoe oe odo ЖЖЖ ЖЖЖ ЖЖС 


REAL*8 X(1000), Y(1000) 
CHARACTER*1 MATR(53, 105), CH 


πι 53) = '*' 


DO 2 K = 1,NOBS 
XK = X(K) 
YK = Y(K) 


CALL COOR(XK, YK, IX, IY) 
CALL CHAR(K, CH) 
2 MATR(IY, IX) = CH 


RETURN 
END 
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SUBROUTINE CHAR(K, CH) 
С ЖЖЖ ЖЖЖ Ж ЖЖЖ ЖЖЖ Ж ЖЕ ЖЖЖ Ж Ж ЖЖЖ ЖЖЖ ЖЖЖ ЖЖ Ж ЖЖ ЕЖЖКЖКЖЖ ЖКЖ ЖЖЖ ЖЖЖ ЖЖ ЖЖЖ ЖЖЖ 


CHARACTER*1 CH 


IF(K.EQ. 1) THEN 
CH = '1' 
RETURN 

END IF 


IF(K.EQ.2) THEN 
CH = '2' 
. RETURN 
END IF 


IF(K.EQ.3) THEN 
CH = '3' 
RETURN 

ENDIF 


IF(K.EQ.4) THEN 
CH = '4' 
RETURN 

ENDIF 


IF(K.EQ.5) THEN 
CH = '5' 
RETURN 

ENDIF 


IF(K.EQ.6) THEN 
СН = '6' 
RETURN 

END IF 


IF (K.EQ.7) THEN 
CH = '7' 
RETURN 

END IF 


IF(K.EQ.8) THEN 
CH = '8' 
RETURN 

ENDIF 


IF(K.EQ.9) THEN 
CH = '9' 
RETURN 

ENDIF 


IF(K.EQ. 10) THEN 
CH = '@' 
RETURN 


100 


ENDIF 


“Ὁ ЕНЕМ 
CH S ni 
RETURN 

END IF 


IF(K.EQ.12) THEN 
CH = '$' 
RETURN 

END IF 


IF(K.EQ.13) THEN 
ОН - е 
RETURN 

ENDIF 


IF(K.EQ. 14) THEN 
CH- & 
RETURN 

ENDIF 


IF(K.EQ. 15) THEN 
CH - , d 
RETURN 

ENDIF 


IF(K.EQ. 16) THEN 
e '/' 
RETURN 

END IF 


IF(K.EQ. 17) THEN 
CH = P 
RETURN 

END IF 


IF(K.EQ. 18) THEN 
CH = '<' 
RETURN 

ENDIF 


IF(K.EQ.19) THEN 
CH = '>' 
RETURN 

ENDIF 


IF(K.EQ.20) THEN 
CH = ο 
RETURN 

ENDIF 

END 
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APPENDIX B. A SMALL EXAMPLE 


Given the following five classes (pictured in Figure B.1) 
as candidates for the class containing the true shortest path: 


We formulate a lower bound for each class. 


l. aya, 
2. O4 
3. αμ) 
4. α)βια)) 
5. αι) αι 


Figure B.1 The Five Classes Associated With Two Obstacles 
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Consider the class e B, ЕІСІСПКЕС Бейом in Figure B.2. 





552 αι 


Figure B.2 The Class e) B, 


To formulate the lower bound for each class we first 
rink the obstacles down to a point (Figure B.3). In order 
to cross а, ме develop a cone of directions (Figure B.3) in 
which the first segment of the bounding polygonal path must 


lie. 





Figure B.3 The Cone of Directions Associated With αι 


που 


This cone is then intersected with the one associated with an 


B, crossing picture түү Gn KT аа 





2i 
Figure B.4 Cone Associated With В, 


The resulting cone of directions is denoted by the double arc 


1n Pigu gpn 5 


В. 7 Bo 


2 90] 


Figure B.5 The Intersected Cone 


Since we have reached the end of the class name we check 
K e if z lies in this cone of directions. If z lies in the 
cone we go directly to z. Otherwise, we determine which side 
of the cone z lies so that we can find the peg on which the 
path bends. 

In this example, z does not lie in the final cone of 
directions so the path bends at the point bi. Thus the 
bounding path is made of two line segments. One from a to b, 


ο Спе осһег from b; to z (Figure B.6). 





о αι 


2 


Figure B.6 The Bounding Path for the Class αι) 


A similar procedure is done on each of the remaining four 


classes yielding the following lower bounds: 


l. aja, S 
2. af3) Ж 55202 
3. a4D, = 2.2885 
4. о,В,а4В, ЖЗ 2252 
5. а)|В,о/В) = 2.7008 
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This list is then put into inereasing orden. 


1. αια) DC UL TO SM 
2. αγΏι mM 5505 
3. а4В, 277777725565 
4. o B.G B; S 2-000099 
5. а,Вуа,В, 5 22555 
Now the first class on this ordered list is chosen. To 


find the true shortest path we expand the obstacles back to 
their original shape. If the path bends on a peg, then a 
tangent line is constructed from a start point to the correct 


side of the obstacle (Figure B.7). 





α 





2 E 


Figure B.7 A Tangent Line From a to B, 


In thezclass aB, we must draw a tangent line from a to 
ο τικ Ύ»» The point ot tami mc yman саш be found by 
using the formulas developed in Chapter V of this paper. We 
then travel around the obstacle until a line tangent to B, can 


be drawn to z (Figure B.8). 
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а 





2 ESI 


Figure B.8 Тһе Shortest Path in the Class a, B. 


Throughout this process the lengths of the line segments 
and the arc lengths representing the distance traveled around 
the obstacles is summed. The final sum is the length of the 
true shortest path for the respective class. 

If the shortest path in a class is smaller than the lower 
bound on the next class to be considered, then the search 
Stops. In this example the search stops after the first class 
is checked since the length of αια] і5 1.8793 апа the length 


of GB 15 1.9032. 
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